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The  design  procedure  is  simple  resulting  in  an  overall  system  which  is  globally  stable 
and  offers  itself  to  microcomputer  implementation.  The  effectiveness  of  the  approach  is 
demonstrated  on  several  computer  simulations  which  compares  its  performances  against 
some  of  the  commonly  known  adaptive  control  techniques. 

Also  presented  is  a  comparison  of  the  computation  complexity  of  different  methods  used 
in  deriving  the  dynamic  equations  of  motion  of  a  mechanical  manipulator  as  well  as  a 
survey  of  various  robot  control  methodologies  available  in  the  literature  today. 
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I.  ROBOTICS  :  AN  OVERVIEW 

A.   INTRODUCTION 

The  19S0's  may  easily  be  characterized  as  the  robotics  era.  The  last  five  or  six  years 
have  experienced  very  strong  social  and  economical  demands  for  advanced  automation  in  a 
fast  expanding  domain  of  applications  ranging  from  the— well  established  car— making 
industry  to  unmanned  underwater  workstations  [1].  Moreover,  there  is  a  widespread  feeling 
that  it  is  likely  that  robots,  in  the  years  ahead,  will  become  crucial  agents  of  industrial 
change,  transforming  production  processes  and  affecting  everyday  lives  [2].  Confronted  with 
these  facts,  we  are  led  to  wonder  about  the  reasons  behind  experts  attaching  such  heavy 
weight  to  robotics  and  about  the  characteristics  that  make  the  industrial  robot  such  a 
powerful  tool. 

An  answer  to  these  questions  may  be  found  by  tracing  the  origins  that  tie  robotics  to 
automation.  Roughly  speaking,  we  can  identify  three  types  of  automation  [3]. 

1.  Continuous  process  controls 

This  type  of  automation  is  used  in  oil  refineries.  It  employs  mostly  computers  with 
no,  or  little,  human  intervention.  This  type  is  highly  automated. 

2.  Hard  automation 

Hard  automation  uses  mainly  transfer  conveyor  methods  to  handle  the  high  volume 
mass  production.  This  type  of  automation  is  based  on  setting  up  specific  assembly  lines 
with  special  tools  and  gadgets.  This  implies  that  hard  automation  relies  on  hardware  which 
cannot  be  easily  changed,  should  a  change  in  the  design  of  a  product  be  called  for. 

3.  Flexible  automation 

Flexible  automation  handles  low  volume  batch  production.  Because  this  type  aims  at 
overcoming  the  limitations  of  hard  automation,  it  is  also  referred  to  as  programmable 
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automation.  This  kind  of  "machine"  is  designed  to  be  flexible  and  to  be  able  to  react  to  its 
environment  in  an  adaptive  fashion.  This  is  clearly  different  from  the  conventional  machine 
which  can  be  used  only  for  well-defined,  specialized,  and  preappointed  tasks.  The 
mechanical  manipulators  used  in  industrial  applications  fall  into  this  category.  However, 
even  though  a  considerable  progress  has  been  made  in  introducing  robots  into  industrial 
situations,  there  is  still  more  to  learn  both  in  overall  concepts  and  practicalities  before  a 
robot  having  a  performance  comparable  to  humans  can  be  built  [4]. 

The  next  section  will  describe  what  is  meant  by  a  "mechanical  manipulator",  in 
general,  and  will  outline  some  of  its  characteristics. 

B.   A  MECHANICAL  MANIPULATOR:  DEFINITION  AND  CHARACTERISTICS 

A  robot  is  a  computer— controlled  mechanical  device  that  can  be  programmed  to 
automatically  move  objects  through  different  configurations  in  space.  Robots  are  normally 
constructed  as  series  of  coupled  rigid  links,  which  together  constitute  what  is  called  a 
kinematic  chain.  There  are  two  types  of  kinematic  chains  [5]: 

1.  The  linkage  or  the  closed  chain,  where  every  link  is  connected  to  at  least  two  other 
links  in  the  chain. 

2.  The  manipulator  or  the  open  chain,  where  some  of  the  links  are  connected  to  only  one 
other  link.  The  articulated  portion  of  most  industrial  robots  is  an  open  kinematic  chain 
with  some  form  of  end  effector  attached  to  the  final  link. 

A  typical  industrial  robot  is  shown  in  Figure  1.1.  The  coupling  of  two  adjacent  links  is 
referred  to  as  a  kinematic  pair  or  joint.  The  most  frequently  encountered  pairs  in  current 
industrial  manipulators  are  the  revolute  or  rotational  joint  and  the  prismatic  or  translation 
joint.  These  pairs  are  shown  in  Figure  1.2.  The  revolute  and  prismatic  joints  are  single 
degree  of  freedom  pairs.  Any  manipulator  must  have  at  least  six  degrees  of  freedom  to 
enable  it  to  achieve  arbitrary  real— world  configurations.  Thus,  most  industrial  robots  are 
constructed  of  exactly  six  links.  The  first  three  degrees  of  freedom  are  generally  referred  to 


Figure  1.1:  Atypical  industrial  mechanical  manipulator 


Prismatic  joint 


Revolute  joint 


Figure  1 .2:  A  revolute  and  a  prismatic  pairs 


as  an  arm  subassembly.  They  are  used  primarily  to  position  the  wrist  unit  at  the 
workpiece.  The  final  three  degrees  of  freedom  are  referred  to  as  the  wrist  subassembly, 
subsequently  employed  to  orient  the  tool  according  to  the  configuration  of  the  object  [6]. 
This  research  is  mainly  concerned  with  the  arm  subassembly.  The  orientation  of  the  tool 
will  not  be  considered. 

C.  ROBOTICS  APPLICATIONS 

Mechanical  manipulators  are  widely  used  in  manufacturing  and  assembly  tasks  such  as 
material  handling,  spot  and  arc  welding,  parts  assembly,  paint  spraying,  loading  and 
unloading  numerically  controlled  machines,  and  in  handling  hazardous  materials  [7]. 
Furthermore,  it  is  now  common  belief  that  robot  systems  can  be  used  in  areas  other  than 
assembly  tasks.  Perhaps  the  most  unusual  application,  to  date,  can  be  found  in  Australia, 
where  a  robot  is  used  for  sheep  shearing  [8].  Another  application  of  robots  is  in  space 
technology.  The  installation  in  the  Space  Shuttle  Columbia  of  a  remote  controlled 
manipulator  to  place  satellites  into  orbit  and  retrieve  them  when  they  fail  is  just  one 
example  [9].  Mechanical  manipulators  have  also  been  used  extensively  in  undersea  research, 
probably  even  more  frequently  than  in  space;  the  latest  example  being  the  robotic  unit 
used  in  the  discovery  of  the  Titanic  [10] .  Robot  systems  could  also  be  used  in  hospitals  to 
help  paralytic  people  or  those  who  must  be  in  bed  after  surgery.  The  household  robot  is 
another  dream.  Military  applications  are  also  appealing.  However,  until  all  the  control 
problems  are  overcome,  the  domain  of  applications  of  robot  systems  will  remain  limited. 
This  will  be  discussed  later,  but,  for  now,  a  typical  structure  of  a  robot  system  is  presented. 

D.  STRUCTURE  OF  A  TYPICAL  ROBOT  SYSTEM 

As  illustrated  in  Figure  1.3,  a  robot  system  is,  functionally,  made  up  of  four  interactive 
parts  [11].  These  different  parts  are: 
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Figure  1 .3:  A  general  structure  of  an  adaptive  robot 


1.  The  mechanical  manipulator 

The  mechanical  manipulator,  itself,  or  the  plant,  is  an  open  chain  of  rigid  links  of  the 
type  previously  shown  in  Figure  1.1.  This  is  the  part  of  the  machine  designed  to  perform  a 
specific  task.  Each  link  is  powered  by  an  actuator  which  physically  moves  the  link  in 
accordance  with  some  prescribed  control  law.  The  joints  are  usually  equipped  with  sensors 
to  allow  for  the  relative  positions  of  the  adjacent  links  to  be  measured. 

2.  The  environment 

The  environment  in  which  the  robot  operates  is  the  physical  universe  surrounding  the 
mechanical  manipulator.  It  includes  not  only  geometrical  considerations,  but  also  the 
physical  laws  governing  this  universe,  the  medium  in  which  the  robot  is  immersed  and  their 
effects  on  the  movements  of  the  robot.  Moreover,  the  robot  payload  changes  constantly 
either  by  handling  parts  of  different  masses  or  changing  tools  and  configurations  from  one 
task  to  the  other.  This  modifies  the  mass  and  inertia  of  the  robot,  which  in  turn  affects  its 
dynamic  behavior.  These  changes  must  be  taken  into  account  in  the  formulation  of  the 
dynamic  model  of  the  mechanical  manipulator. 

3.  The  task 

The  task  to  be  carried  by  the  manipulator,  or  the  trajectory  planner,  may  differ  from 
one  application  to  another.  In  most  cases,  however,  the  ultimate  task  is  driving  the  end 
effector  of  the  manipulator  to  a  desired  position  in  the  workspace.  Naturally,  this  position 
is  expressed  in  cartesian  or  world  coordinates.  Theoretically,  the  task  might  be 
accomplished  in  any  fashion,  as  along  as  the  tool  reaches  the  final  desired  position  and 
remains  there.  More  realistically,  the  robot  must  meet  certain  requirements  in  performing 
its  task  [12]: 

1.  The  motion  must  be  as  fast  as  possible,  otherwise,  the  use  of  robots  would  not  have 
been  efficient. 

2.  No  overshoot  of  the  final  position  is  allowed  to  prevent  damages  to  the  environment. 


3.  The  mechanical  manipulator  must  be  able  to  avoid  obstacles  that  may  be  present  in  its 
workspace. 

4.  The  motion  must  be  smooth,  in  order  to  avoid  the  increased  wear  on  the  mechanism 
and  the  resonances  caused  by  vibrations  due  to  rough  and  jerky  motions. 

Therefore,  stating  the  initial  and  final  conditions  alone  is  not  a  sufficient  task 
description.  In  most  cases,  it  is  necessary  for  each  link  to  follow  a  prescribed  trajectory  in 
terms  of  position,  velocity,  and  acceleration  at  each  instant  of  time.  The  desired  trajectory 
can  be  made  by  the  combination  of  any  smooth  functions  joining  the  initial  and  final 
positions  and  satisfying  all  the  constraints.  Cubic  functions  are  among  the  most  commonly 
used  trajectories  since  they  are  easy  to  generate  [13]. 
4.   The  controller 

The  controller  generates  the  control  signals  that  excite  the  corresponding  actuators  to 
produce  the  torques  necessary  to  maintain  a  prescribed  motion  of  the  arm  along  the  desired 
trajectory.  The  control  strategy  is  determined  according  to  both  the  control  task  and  the 
mechanical  manipulator  equations  of  motion.  It  is,  however,  usually  derived  on  the  basis  of 
a  trajectory  expressed  in  joint  coordinates.  Therefore,  a  transformation  from  world 
coordinates  to  link  coordinates  must  be  performed  before  the  signals  sent  by  the  trajectory 
planner  can  be  used  by  the  controller. 

In  practice,  the  four  functions  described  above  closely  interact  with  each  other.  When 
in  operation,  the  computer  receives,  at  each  instant  of  time,  information  concerning  the 
robot  and  information  concerning  the  environment.  By  using  this  information  in 
conjunction  with  the  control  law,  it  causes  the  manipulator  to  move  toward  the  correct 
execution  of  the  task  assigned  to  it. 

This  thesis  addresses  the  design  of  control  systems  in  order  for  the  manipulator  to 
adapt  to  a  changing  environment,  as  described  by  functions  2  and  4  above.  The  next 
section  defines  in  more  detail  the  mechanical  manipulator  control  problem  and  addresses 
some  of  the  difficulties. 
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E.  THE  ROBOT  CONTROL  PROBLEM 

Robotics,  while  bringing  together  many  well  established  fields  of  engineering,  is 
relatively  a  new  science  in  itself.  It  still  suffers  from  many  unsettled  points.  Controlling  the 
robot  system  to  perform  in  certain  way  is  one  of  its  most  challenging  problems  due  to  the 
fact  that  these  systems  are  highly  nonlinear.  A  formal  statement  of  this  problem  is  not, 
however,  as  difficult  as  trying  to  find  a  satisfying  solution  for  it.  In  general  terms,  the  robot 
control  problem  can  be  formulated  as  follows: 


Given  a  desired  trajectory  generated  by  the  trajectory  planner  and  a  m< 
of  the  mechanical  manipulator  and  its  interactions  with  the  environmen 


lathematical  model 
lment,  find  the  control 
algorithm  which  sends  torque  commands  to  the  actuators  in  order  to  cause  the  desired 
motion  to  be  realized. 


One  may  now  recognize  that  the  robot  control  problem  as  stated  here  is  basically  a 
stability  problem,  along  the  given  trajectory. 

Mechanical  manipulators  may  be  modeled  precisely  enough,  since  their  behavior  is 
described  by  the  known  laws  of  mechanics  [14].  This  knowledge  should  be  used  in  the 
control  synthesis  as  extensively  as  possible.  As  stated  earlier,  this  problem  is  extremely 
difficult  because  the  robot  systems  are  inherently  characterized  by  nonlinear  dynamics  that 
include  nonlinear  couplings  between  the  variables  corresponding  to  different  motions. 
Furthermore,  the  dynamic  parameters  of  the  manipulator  vary  with  position  of  the  joint 
variables,  which  themselves  vary  in  time  and  with  respect  to  each  other.  These  difficulties 
make  the  implementation  of  real  time  dynamic  control  computationally  impractical  in 
today's  computers.  Therefore,  one  of  the  intriguing  questions  arising  in  the  solution  of  the 
control  task  is  to  what  extent  one  should  take  into  account  real  robot  dynamics  in  control 
synthesis. 

Current  industrial  practices,  in  order  to  take  advantage  of  the  well-established  linear 
systems  and  control  theory,  model  the  manipulator  as  a  chain  of  constant— parameter, 


uncoupled  linear  subsystems.  These  design  procedures,  which  may  be  referred  to  as  the 
servo  mechanism  control  methodologies,  while  yielding  satisfactory  performances  at  low 
speeds,  have  proven  to  be  inefficient  for  faster  and  more  accurate  robotics  applications  [15]. 
Recently,  more  researchers  have  turned  to  adaptive  control  in  an  attempt  to  be  able  to 
take  advantage  of  the  full  robot  dynamics  and  to  overcome  the  limitations  of  the  actually 
available  practices  [16,17].  These  new  approaches  may  be  referred  to  as  adaptive  control 
strategies  for  mechanical  manipulators.  However,  no  completely  acceptable  answer  has 
been  given  to  the  question  of  how  to  use  the  knowledge  of  the  robot  dynamics  to  synthesize 
such  control  that  would  be  simple  enough  to  implement  in  practice  and  to  guarantee 
satisfactory  system  behavior.  Several  other  problems  remain  [18],  such  as: 

1.  The  lack  of  adequate  sensors  for  the  acquisition  and  pre— processing  of  information 
received  from  the  environment,  particularly  visual  information. 

2.  The  state  of  development  of  overall  theory  is  not  yet  fully  developed;  and, 

3.  The  slowness  of  the  computations  involved. 

The  first  problem  is  more  of  a  technological  problem  than  theoretical  one  and  will  not  be 
dealt  with  in  this  context.  The  last  two  problems  are  inherently  related  to  the  robot  control 
problem  and  will  constitute  an  important  part  of  this  research. 

F.   LITERATURE  REVIEW 

This  section  presents  some  of  the  most  representative  solutions  to  the  mechanical 
manipulator  control  problem  as  of  today.  The  main  difficulty,  however,  in  trying  to  review 
the  literature,  is  that  different  approaches  have  been  developed  for  different  classes,  types, 
configurations,  and  purposes.  We  will  primarily  consider  the  approaches  to  the  control 
synthesis  for  industrial  manipulators.  We  will  also  restrict  ourselves  to  dynamic  control 
which  takes  into  account  dynamic  effects  of  the  robotics  system.  Control  strategies  both  in 
terms  of  open  loop  and  closed  loop  control  have  been  examined  [19]. 
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1.  Open  loop  control  systems 

In  this  case,  the  trajectory  is  preplanned  or  prerecorded  and  the  input  torques  do  not 
depend  on  link  position  and/or  velocity  measurements.  The  performances  are  defined  in 
terms  of  desired  cost  minimization  criteria. 

Along  these  lines,  Kahn  [20]  has  considered  the  time  optimal  control  problem, 
Whitney  [21]  has  studied  the  minimum  energy  trajectories,  and  Young  [22]  has  been 
interested  in  minimizing  a  quadratic  function  in  acceleration. 

Due  to  the  highly  nonlinear  model  of  the  manipulator,  numerical  solutions  only  can 
be  obtained  and  stored  in  memory.  In  general,  this  yields  a  control  which  is  optimal 
provided  the  system  is  not  affected  by  unexpected  disturbances.  Also  the  open  loop 
approach  leads  to  schemes  which  are  very  sensitive  to  parameter  variations.  Disturbance 
rejection  and  position  tracking  can  only  be  achieved  through  accurate  mechanical  design. 
The  performances  of  the  systems  are  limited  by  the  capabilities  of  the  actuators  and  by  the 
vibrations  induced  in  the  mechanism  by  the  excitation  of  high  frequency  structural  modes. 
The  on-line  implementation  of  such  control  laws  is  very  involved  and  might  demand  a 
rather  complex  multiprocessor. 

2.  Closed  loop  control  systems 

These  feedback  control  strategies  are  derived  either  through  well  known  classical 
servomechanism  procedures,  or  through  more  recent  adaptive  control  techniques  for  their 
ability  to  account  for  parameter  uncertainties. 

a.  The  servomechanism  approaches 

Kahn  and  Roth  [23]  have  proposed  an  approximated  optimal  law  which,  for  a 
particular  robot,  has  resulted  in  response  times  and  trajectories  reasonably  close  to  the 
optimal  solutions.  For  more  complex  manipulators,  however,  this  solution  might  be 
unacceptable.  Furthermore,  the  controller  proposed  in  [23]  is  based  on  a  bang  bang 
approach,  often  unacceptable  due  to  continuous  chattering  of  the  joint  actuator's  signals. 
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Vukobratovic  and  Stokic  [24]  addressed  the  more  general  problem  of  designing  a 
controller  which  yields  desired  tracking  while,  at  the  same  time,  minimizes  an  appropriate 
cost  criterion. 

Because  of  analytical  and  computational  complexity,  approaches  by  optimal 
synthesis  have  been  developed  for  positional  control  problems  only.  To  solve  the  problem  of 
tracking  a  prescribed  trajectory,  Popov  and  co-authors  [25]  introduced  an  alternative 
approach  which  consists  of  calculating,  off  line,  the  nominal  trajectory  by  some  optimal  or 
suboptimal  procedures  and  then  following  the  obtained  path. 

The  design  of  control  systems  based  on  the  exact  nonlinear  model  of  the 
manipulator,  in  general,  yields  algorithms  not  suitable  to  real  time  implementations.  For 
this  reason,  controllers  based  on  linearized  models  in  the  neighborhood  of  operating 
conditions  have  been  introduced.  This,  however,  guarantees  the  stability  of  the  linearized 
model  only.  Instabilities  might  occur  in  the  actual  system  due  to  nonlinearities  in  the 
mechanism,  coupling  between  different  joints,  or  parameter  variations.  In  order  to 
overcome  this  major  difficulty,  several  additional  compensation  schemes  have  been 
proposed  [26,27]  at  the  expenses  of  added  complexity. 

In  a  different  context,  Paul  [28]  has  investigated  the  so  called  inverse  problem 
technique  (also  named  the  computed  torque  by  Bejczy  [29]).  This  approach  uses  the  desired 
position,  the  desired  velocity,  and  the  desired  acceleration  to  compute  the  driving  torques. 
The  main  drawback  of  this  scheme  is  that  the  computation  of  the  complete  nonlinear 
dynamic  model  is  required.  Simplifications  have  been  obtained  by  Paul  [30],  Bejczy  [31], 
Raibert  and  Horn[32]  by  omitting  some  of  the  terms  in  the  model.  These  simplifications, 
while  reducing  the  computational  complexity,  are  still  not  enough  for  real  time 
implementation  of  any  control  strategy  based  on  this  technique. 

Vukobratovic  and  Stokic  [33]  have  recognized  that  the  forces  (moments)  acting  on 
the  robot  joints  can  be  directly  measured  and  used  to  synthesize  a  feedback  law  that 
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compensates  for  the  coupling  in  the  robotics  manipulator  and  relieves  the  controller  from 
on  line  computation  of  these  complex  terms.  Other  attempts  to  include  force  feedback 
control  account  for  the  work  of  Hewit  and  Burdess  [34]  who  introduced  force  transducers  in 
the  joints  of  the  manipulator.  Although  the  computation  time  is  shorter,  their  scheme  is 
still  too  complex  for  real  time  implementation.  Wu  and  Paul  [35]  implemented  an  analog 
force  feedback  loop  on  a  single  joint  manipulator  which  avoided  the  computational 
difficulty.  Luh,  Fisher,  and  Paul  [36]  have  analyzed  the  effects  of  linear  independent  joint 
torques  control.  The  stability  of  the  overall  system,  however,  has  not  been  discussed  in  any 
of  these  papers.  There  were  other  attempts  to  use  force  feedback,  not  only  at  the  executive 
control  level  but  to  include  assembling  tasks,  such  as  in  the  resolved  motion  control 
introduced  by  Whitney  [37];  the  resolved  acceleration  control  by  Luh,  Walker,  and  Paul 
[38];  and  the  resolved  force  control  by  Wu  and  Paul  [39]. 

The  simplest  and  most  widely  used  control  method  today  is  based  on  decoupling 
and  joint  control.  Yuan  [40]  tried  to  dynamically  decouple  a  manipulator  by  linear  control. 
An  effective  analysis  of  a  constrained  linear  control  may  be  found  in  Golla,  Garg,  and 
Hughes  [41].  Freund  [42]  attempted  the  decoupling  by  nonlinear  control  involving  full  state 
feedback  which  guarantees  stability  in  the  absence  of  external  disturbances.  Young  [43] 
developed  a  variable  structure  controller  for  manipulators, 
b.   Adaptive  techniques 

In  addition  to  the  computational  complexity,  the  servomechanism  approaches 
cannot  always  satisfy  the  stability  conditions  even  if  designed  to  be  robust  with  respect  to 
parametric  and  state  disturbances.  Adaptive  control  methodologies  aim  at  overcoming 
these  difficulties. 

Within  the  adaptive  control  theory,  two  fundamental  approaches  exist  in  the 
literature  [44].  The  first  is  the  Learning  Model  Adaptive  Control  (LMAC),  in  which  an 
improved  model  of  the  plant  is  obtained  by  on  line  parameter  estimation  techniques,  and  is 
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then  used  in  the  feedback  control.  A  general  structure  of  this  approach  is  shown  in  Figure 
1.4.  The  estimated  model  and  the  controller  may  be  either  linear  or  nonlinear  depending  on 
the  estimation  technique  used.  The  well  known  Self  Tuning  Regulator  method  belongs  to 
this  class.  The  second  approach  in  adaptive  control  theory  is  the  Model  Reference  Adaptive 
Control  (MRAC).  The  controller  is  adjusted  so  that  the  dynamics  of  the  closed  loop  system 
matches  that  of  a  preselected  model.  A  general  structure  of  this  methodology  is  given  in 
Figure  1.5.  In  general,  the  reference  model  is  chosen  to  be  a  stable,  linear,  time— invariant, 
decoupled  system.  The  controller  may  be  either  linear  or  nonlinear.  It  is  also  possible  to 
design  adaptive  schemes  which  combine  both  techniques. 

Many  different  structures  of  self  tuning  regulators  are  available  in  the  literature, 
and  they  differ  in  parameter  estimation  technique  and  control  algorithms  [45].  Koivo  and 
Guo  [46]  examined  the  feasibility  of  least  squares  techniques  to  robotics  applications.  Their 
approach  is  configuration  dependent  and  does  not  account  for  nonlinearities  in  the  system. 
It  is  based  on  estimation  of  the  linearized  dynamics  and  does  not  take  advantage  of  any  a 
priori  knowledge  of  the  system  that  might  be  available  to  the  designer.  Elliot,  Depkovich, 
and  Drapper  [47]  gave  an  extension  of  this  method  to  the  nonlinear  case  taking  advantage 
of  the  fact  that,  in  spite  of  their  nonlinear  nature,  the  parameters  in  the  dynamic  equations 
of  a  robot  system  appear  linearly.  This  method  showed  better  tracking  ability,  but  did  not 
solve  the  computation  complexity.  Cristi,  Das,  and  Loh  [48]  exploited  this  idea  of  linear 
parameterization  of  the  dynamic  equations  to  give  one  of  the  first  attempts  to  formulate  an 
adaptive  version  of  the  computed  torque  technique.  Their  scheme  consisted  of  an  on  line 
loop  to  estimate  the  pay  load  and  an  off  line  loop  to  estimate  the  other  parameters  of  the 
manipulator.  The  good  feature  of  this  approach  is  that  it  guarantees  global  stability  of  the 
system.  In  similar  fashion,  Craig,  Hsu  and  Sastry  [49]  proposed  another  adaptive  computed 
torque  controller  version,  based  on  linear  parameterization  of  the  dynamic  equations,  and 
have  established  global  convergence  for  their  scheme.  This  method  assumes  no  a  priori 
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knowledge  about  the  system  and  requires  acceleration  measurements,  which  makes  it 
numerically  complex.  Middeleton  and  Goodwin  [50]  gave  an  extension  of  this  method  based 
on  position  and  velocity  measurements  only.  This  method  is  still  complex  for  real-time 
implementation.  Lee  and  Chung  [51]  exploited  the  self— tuning  regulator  structure  by 
introducing  the  adaptation  at  the  level  of  linearized  perturbation  equations  in  the  vicinity 
of  a  nominal  joint  trajectory.  Their  approach  uses  the  recursive  Newton— Euler  equations 
for  feedforward  computation  of  nominal  control  and  a  recursive  least  squares,  one  step 
ahead  control  for  feedback  corrections  about  the  nominal  trajectory.  The  number  of 
computations  involved  is  reduced.  However,  this  method  can  only  compensate  for  small 
deviations.  An  attempt  to  speed  up  this  method  by  avoiding  the  use  of  the  Newton— Euler 
recursion  was  performed  by  Vukobratovic  and  Kircanski  [52].  Their  scheme  is  based  on 
local  adjustable  controllers  at  each  joint.  The  controller  consists  of  a  nominally  tuned 
feedforward  PID  structure,  and  a  feedback  corrective  portion  to  account  for  parameter 
variations.  This  method  relaxes  the  computational  burden  by  introducing  a  computer  for 
each  link,  instead  of  one  main  computer  for  the  whole  robot  system. 

There  are  four  basic  approaches  to  the  design  of  Model  Reference  Adaptive 
Control  Systems  [53]: 

1.  Local  parametric  optimization  theory 

2.  Lyapunov  functions 

3.  Variable  structure  systems 

4.  Hyperstability  and  positivity  concepts 

Within  the  local  parametric  optimization  techniques,  Dubowsky  and  DesForges 
[54]  used  the  steepest  descent  method  to  develop  one  of  the  first  contributions  in  adaptive 
control  for  robot  manipulators.  This  method  is  computationally  less  burdensome  and  has 
good  noise  rejection  properties.  However,  the  steepest  descent  algorithm,  while  it  can  yield 
better  adaptation  speed,  calls  for  many  simplifications  and  may  negatively  influence  the 
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overall  stability  of  the  manipulator.  The  input  signal  may  also  become  excessively  large 
due  to  the  fact  that  only  the  output  error  is  minimized.  The  discrete  time  version  of  this 
method  [55],  as  well  as  the  multi variable  case  [56],  have  also  been  developed  by  Dubowsky. 
The  later  approach  was  tested  on  an  industrial  robot  and  showed  the  significance  of 
adaptive  control  in  high  speed  tracking  operations. 

Takegaki  and  Arimoto  [57]  have  considered  the  applicability  of  model  reference 
adaptive  control  theory  in  robotics,  using  the  Lyapunov  function  approach.  Their  scheme 
included  a  nonadaptive  gravity  compensation  loop.  This  resulted  in  simple  adaptation  and 
control  laws,  thus  making  it  suitable  for  real  time  implementation.  However,  how  the 
gravity  compensation  loop  affected  the  tracking  quality  could  not  be  shown. 

Young  [5S]  combined  the  variable  structure  theory  with  the  model-following 
approach  and  investigated  their  use  in  robot  positioning  problems.  This  approach  also  uses 
less  computation.  It,  however,  uses  the  hierarchical  control  methodology  of  Utkin  [59], 
which  may  not  be  valid  if  only  asymptotic  convergence  can  be  reached.  In  addition,  the 
control  signals  are  discontinuous  and  the  high  frequency  components  may  become 
unacceptable.  This  method  suffers  also  from  the  fact  that  there  are  no  design  procedures  for 
tuning  the  controller  parameters.  Slotine  and  Sastry  tried  [60]  to  remove  some  of  these 
difficulties  by  using  the  concept  of  time  varying  sliding  surfaces  in  the  state  space.  They, 
however,  trade  off  accuracy  against  chattering  by  approximating  the  obtained 
discontinuous  control  law  by  a  continuous  one. 

Horowitz  and  Tomizuka  [61]  presented  one  of  the  first  attempts  to  apply 
hyperstability  theory  to  robotics.  Their  algorithm  has  been  later  implemented  on  a  three 
degree  of  freedom  manipulator  by  Anex  and  Hubbard  [62]  after  been  slightly  modified  to 
compensate  for  gravity.  The  advantage  of  this  method  is  that  the  adaptation  mechanism  is 
derived  from  the  condition  of  overall  system  stability.  Its  main  problem  is  the  fact  that  the 
dynamical  effects  are  estimated  without  using  any  a  priori  knowledge  about  the  system 
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dynamics.  In  practice,  many  of  the  robot  parameters  are  known  and  it  would  be  convenient 
to  estimate  only  the  unknown  ones.  The  application  of  hyperstability  theory  to  robotics 
models  has  been  fully  developed  by  Balestrino,  De  Maria,  and  Sciavicco  [63].  Their  strategy 
offers  better  transient  behavior  compared  to  that  with  self— tuning  regulators  and  it 
guarantees  stability  of  the  entire  system.  The  main  drawback  of  this  method  is  the 
possibility  of  excessive  control  signals  and  its  high  numerical  complexity. 

As  a  conclusion,  let  us  note  that  adaptive  methods  for  manipulation  robot  are  still 
in  their  early  stages  of  development.  It  is,  therefore,  very  difficult  to  produce  an  exhaustive 
survey  of  these  methods  as  new  design  ideas  continue  to  appear  in  the  literature.  So  far  we 
have  summarized  some  of  the  approaches  available,  far  from  a  complete  treatment  of  the 
problem. 

G.   THESIS  OUTLINE 

The  remaining  of  this  research  will  be  centered  around  the  development  of  adaptive 
control  strategies  applied  to  robotics  systems.  Fundamental  to  the  problem  of  dynamic 
control,  the  derivation  of  the  dynamic  equations  of  motion  will  be  addressed  in  Chapter 
Two.  Different  approaches  to  obtaining  these  equations,  as  well  as  their  computational 
complexity  will  be  discussed. 

In  Chapter  Three,  a  new  adaptive  control  law  which  will  combine  properties  from  both 
the  STR  technique  in  [51]  and  the  hyperstability  principal  in  [63]  will  be  presented.  This 
methodology  has  the  advantage  of  assuring  global  stability  and  aims  at  overcoming  many 
of  the  limitations  of  the  previously  studied  schemes.  It  makes  use  of  a  nominal  dynamics 
feedforward  compensation  loop,  but,  unlike  Ref.[51],  the  stabilizing  feedback  loop  does  not 
call  for  any  simplifying  assumptions.  A  rapprochement  between  this  method  and  the 
AMFC  will  be  established,  but,  unlike  Ref.[63],  it  does  not  require  excessive  actuation. 
Most  of  all,  our  approach  yields  better  performance  and  is  numerically  very  efficient. 

19 


II.   MECHANICAL  MANIPULATOR  DYNAMICS 

A.   INTRODUCTION 

In  order  to  design  a  controller  of  an  articulated  mechanical  system,  it  is  necessary  to 
have  a  mathematical  model  the  system.  This  model  expresses  the  relationships  among 
different  components  of  the  robotics  system  and  the  interactions  between  the  mechanical 
manipulator  as  a  whole  and  the  physical  universe  surrounding  it.  It  is  described  in  terms  of 
characteristic  variables  which  are  specific  to  the  system,  such  as  degrees  of  freedom, 
lengths,  masses,  inertias,  positions,  forces,  and  torques. 

The  number  and  nature  of  the  parameters  used  in  each  model  depend  on  the  application 
and  the  accuracy  required.  The  designer  is  constantly  faced  with  the  challenge  of 
developing  models  that  adequately  represent  the  dynamics  of  the  system,  and  that  are 
computationally  convenient  for  computer  implementations. 

Because  of  the  high  speeds  required  in  any  future  robotics  application,  dynamic 
phenomena,  such  as  frictional,  inertial,  centrifugal,  and  coupling  forces  should  be  taken  into 
consideration  for  the  chosen  model  to  be  representative  of  the  actual  mechanical 
manipulator  behavior. 

An  efficient  mathematical  model  of  a  robot  is  essential  for  both  design  and  control 
purposes.  In  the  design  phase,  a  complete  dynamic  model  is  useful  for  determining  loads, 
dimensions,  tolerances  and  actuation.  In  control  applications,  the  dynamic  model  is  used  to 
generate  the  nominal  joint  torques  as  well  as  to  simulate  and  test  control  strategies  without 
the  need  of  building  a  prototype  (at  least  in  the  early  stages  of  the  design). 

There  are  two  problems  related  to  the  dynamics  of  a  manipulator.  In  the  inverse 
dynamics  problem,  we  are  given  a  trajectory  in  terms  of  joint  coordinates  q(t)  and  their 
derivatives.  q(t)  and  q(t),  and  we  wish  to  find  the  corresponding  sets  of  vector  torques  r. 
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This  formulation  is  at  the  basis  of  the  control  problem.  The  second  formulation  is  the 
direct  dynamics  problem.  In  this  formulation,  we  wish  to  calculate  the  resulting  motion  of 
the  manipulator  q(t),  q(t)  and  q(t)  for  every  given  set  of  vector  torques  r.  This  is  at  the 
basis  of  the  simulation  of  the  robotics  system. 

There  are  several  possible  approaches  one  can  take  to  derive  the  dynamics  equations  of 
an  articulated  mechanical  system.  Newton-Euler's  equations,  Gibbs'  functions, 
d'Alembert's  formalism,  Bond  graphs  and  Lagrange  equations  are  only  few  of  these 
methods. 

Lagrange  and  Newton— Euler  equations  are,  however,  the  most  frequently  used  in  the 
literature.  In  this  chapter,  we  will  present  several  alternative  formulations  of  these  two 
methods,  address  their  computational  performances,  and  show  that  one  can  easily  be 
derived  from  the  other. 

B.   CLOSED-FORM  LAGRANGIAN  MANIPULATOR  DYNAMICS 

This  formulation  was  first  applied  to  open  loop  kinematic  chains  by  Kahn  [64]  from  the 

more  general  linkage  problem  of  Uicker  [65],  and  has  served  as  the  standard  manipulator 

dynamics  for  over  a  decade.  We  begin  this  derivation  by  presenting  the  notation  used 

throughout  the  development. 

The  links  of  a  manipulator  are  numbered  consecutively  from  1  to  n  starting  from  the 

base  to  the  tip.  By  convention,  the  reference  frame  is  numbered  as  link  0.  The  joints  are 

numbered  so  that  the  joint  i  connects  link  i-\  to  link  i.  An  orthogonal  coordinate  system  is 

fixed  in  each  link  as  follows: 

z-  is  directed  along  the  axis  of  joint  i+1, 

x-  lies  along  the  common  normal  from  z-  ,  to  z-,  and 

y  completes  the  right  handed  coordinate. 
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The  relative  position  of  two  adjacent  links  is  completely  described  by: 

a  ■,  the  distance  between  the  origins  of  coordinate  systems  *— 1  and  i  measured  along  x-, 

s-,  the  distance  between  x-  ,  and  x-  measured  along  z-  ,, 

a  .,  the  angle  between  the  z-,  and  z-  axes  measured  in  a  righthand  sense  about  x-,  and 

I  t     'A  I  % 

9-,  the  angle  between  the  x-  ■.  and  x-  axes  measured  in  the  righthand  sense  about  z-  , . 

This  notation  is  summarized  in  Figure  2.1.  If  the  joint  is  rotational,  the  joint  variable  will 
be  6  ■;  if  translational,  the  joint  variable  will  be  s-  The  symbol  q.  will  designate  the 


variable  for  joint  i  whether  it  is  s-  or  $..  The  vector  q  = 


^1 

^2 


^n 


represents  the  generalized 


coordinates  of  the  manipulator  and  completely  specifies  its  position.  In  the  subsequent 
development,  lower  case  and  uppercase  regular  letters  will  be  used  indifferently  to 
designate  scalar  quantities,  lower  case  bold  letters  to  designate  vectors,  and  capital  bold 
letters  to  designate  matrices.  Subscripts  refer  to  the  physical  location  of  the  variable, 
superscripts  to  the  coordinates  frame  the  variable  is  expressed  in.  Either  of  these  is  omitted 
when  referring  to  the  base  coordinates  frame. 

The  Lagrange  equations  for  a  nonconservative  system  are: 

i—-  —  =rt,      !=1,2 n  (2.1) 

where, 
L  =  K  —  P  is  the  Lagrangian  function, 
K  is  the  total  kinetic  energy  of  the  manipulator, 
P  is  the  total  potential  energy  of  the  manipulator, 
q  ■  is  the  generalized  coordinate  of  the  manipulator, 
q  •  is  the  first  time  derivative  of  the  generalized  coordinate,  and, 
t •  is  the  torque  applied  to  the  system  at  joint  i. 
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Link 


Link    i+1 


Figure  2. 1 :  The  standard  axes  definitions  for  connected  links 


23 


To  find  the  kinetic  energy  of  the  physical  system,  we  need  to  know  the  velocity  of  each 


joint.  Let  p 


z- 
ll 


ih 

denote  the  coordinates  of  link  i  in  the  reference  frame  of  the  i     link; 


1  j 1 

p.,  the  same  point  p.  with  respect  to  the  base  coordinates  frame;  T 

%  9  I 


R^1      AM 
i  % 

0  0  0    1 
th 


the  homogeneous  coordinate  transformation  which  relates  the  displacement  of  the  i  link 
coordinate  frame  to  the  (i-1)  link  coordinate  frame;  and  T  the  coordinate 
transformation  which  relates  the  i  coordinate  frame  to  the  base  coordinate  frame.  The 
rotational  transformation  R       and  the  translational  transformation  A-      are  given  by: 

I  i 


i-l 
Ri      = 


cos#-  -  sin#.  costf-      sinfl-sinft. 
i  i        i  i        i 

sin0-      cos0-cosa-  —  cos#-sina- 

i  i        i  i        i 

0  sina-  cosa- 

%  % 


(2.2) 


and, 


r  = 


p  a-  cos#- 
p  a- sin#- 

s, 


'1  for  a  revo  1  ute  joint 
0  for  a  prismatic  joint 


(2.3) 


The  variables  p  •  and  p  •  are  related  by: 


where 


p.  =  T.p. 
yi         iyi 


T.  -  Tj  T^.T*-1 


i 


(2.4) 


(2.5) 


Assuming  rigid  body  motion,  all  the  points  p  will  have  zero  velocity  with  respect  to  the 

th  i 

i     coordinate  frame.  The  velocity  of  p  •  expressed  in  the  base  coordinate  frame  is: 


v-  = 
i 


=  at(pp =  at^iPJ) 


(2.6) 
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Since  p  •  =  0,  v  •  can  be  written  as: 
m  i 


r    I 


where 


<9T 


3q 


7=1   HJ    J 


t-1 

L-=QirH, 


and 


<9T 
j 

0q. 


The  matrix  Q   being: 


Qr 


T?To...T^?Q.T^_1...T?_1,  for  7  <  i 


f  or  j  >  z 
j=l,2,.  ..,n 

'  z/=l  and   //=0  for 
a    revo  1  ut  e  joint 

z/=0  and   //=1  for 
a   prismat  i  c  joint 

0T, 


0-^00 
1/  0  0  0 
0  0  0// 
0    0  0  0 


with 


(2.7) 


(2.8) 


(2.9) 


(2.10) 


In  order  to  simplify  notations,  let  us  define  U  ■  =  ,  then  equation  (2.9)  can  be 

13    d«j 


written  as  follows: 


U. 


y 


T    .  Q-T-Hjor  j  < 
0  for  j  >  i 


,     2=1, 2,...,  n 


(2.11) 


Using  this  notation,  v  •  can  be  expressed  as: 


v  = 
1 


(2.12) 


The  matrix  U  ■  •  is  the  rate  of  change  of  the  point  p  on  link  i  relative  to  the  base  coordinate 
frame  as  q  •  changes.  It  represents  both  the  linear  and  angular  velocities  of  the  link. 
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The  kinetic  energy  of  an  infinitesimal  mass  dm  on  link  i  is  found  as: 

dk-  =  it  (x-  +  y  ■  +  z-)dm 
dk-^Tr^.ypdm 
where  a  trace  of  an  nxn  matrix  A  is  defined  as: 


(2.13) 


n 


Tr(A)  =  I 


11 


i=\ 


Substituting  equation  (2.12)  for  v.,  the  kinetic  energy  of  the  infinitesimal  mass  becomes: 


i      l 


^ 


i      i 
X=lk=l 


(2.14) 


For  the  whole  link, 


Kr/dk 


Tr 


i 
i      i 

A=lifc=l 


?T 


(2.15) 


The  integral  term  inside  the  bracket  is  known  as  the  pseudo  inertia  matrix  J-  of  all  the 
points  on  link  i  with  respect  to  the  proximate  joint  of  link  i  expressed  in  the  i     link 

coordinates  system. 

,i      r    i    ft  ■ 
Ira 


l         f     l      2™ 

JrJp2p?  d; 


J'  = 


fxZdm         jxfljdm    Jj.z.dra    Jz-dra 
jj-y-dra    fytdm         Jt/^-dra    Jy-dra 


i    i 


\x-z    dm    \y-z  -dm    \z2-dm         \z  -dm 
jx-dm         Jydra         jz-dm         Jdra 

III 


(2.16) 


The  inertia  tensor  I'    of  link  i  about  its  center  of  mass  in  the  i     coordinate  frame  is 

uv 


defined  as: 


uv     J      uv  [L   k  J        u  v 
k 


dm 


■th 


where  the  indices  u,v,k  indicate  principal  axes  of  the  i     coordinate  frame  and  S     is  the 
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2— D  Kronecker  delta.  The  pseudo  inertia  matrix  J-  can  then  be  expressed  in  terms  of  the 


inertia  tensor  I     as: 
uv 


,•= 


-I*  +ll  +Il 

xx     yy     zz 

2 


I 


i 


xy 

xx     yy     zz 
2 


i 

xz 

i 


xz 


1  c 


yz 

i"c. 


yz 

i 

xx  '  '  yy  ~zz 


ll  +ll   -ll 


I  C. 


m;z„ 
lCi 


m  -z„     m- 
i  c-       i 


(2.17) 


where  c  ■  = 


c 
i 


is  the  center  of  mass  vector  of  link  i  from  the  i  l  link  coordinate  frame 


:th   ,- 


and  expressed  in  the  i     link  coordinates  system. 

The  total  kinetic  energy  K  of  the  manipulator  arm  can  be  expressed  as: 


n 


K=l  K 


n      i      i 


i=lA=lifc=l 


(2.18) 


Note  that  the  terms  J  •  are  dependent  on  the  mass  distribution  of  link  i  and  not  on  their 
position  or  rate  of  motion.  Hence,  the  J  ■  need  to  be  computed  only  once  for  evaluating  the 
kinetic  energy  of  the  manipulator. 


The  potential  energy  P  ■  of  the  link  i  is: 


P^  =  -  m£V;  =  -  m. 


T-p* 


row 
The  total  potential  energy  of  the  manipulator  then  becomes: 


(2.19) 


where  g  =  [  g   g    g,  0  ]  is  the  gravity  row  vector  expressed  in  the  base  coordinate  system. 
x    y    z 
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T.p*. 


n  n 

i=l  i=l 

and  the  Lagrangian  function  L  then  becomes: 

n      i      i 


(2.20) 


n 


(2.21) 


i=lA=lifc=l  i=\ 

Performing  the  differentiation  in  the  Lagrange  equations  and  rearranging,  we  obtain  the 

necessary  generalized  torque  t  •  for  joint  i  actuator  to  drive  the  i     link  of  the  manipulator. 

d    dL         dL 

7i    A  n    A     A  n 

\=ik=l  \=ik=ll=l  \=i 

i  —  1 , 2  , . . .  ,  n 


The  above  equation  can  be  expressed  in  a  matrix  notation  as: 

n  n    n 

k=i  &=i/=i 

or  in  more  compact  form  as: 


r(t)  =  A 


q(t) 


q(t)  +  V 


q(t),q(t) 


+  G 


q(t) 


where 


r(t)  = 


T    -i 
1 

T 

.  9 


is  an  nxl  generalized  torque  vector  applied  at  joints  t=l,2,...,n, 


q(t)  = 


is  an  nxl  vector  of  the  joint  variables  of  the  manipulator, 


(2.22) 


(2.23) 


(2.24) 
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rQ 


q(t)  = 


is  an  nxl  vector  of  the  joint  velocity  of  the  manipulator, 


q(t)  = 


% 


is  an  nxl  vector  of  the  acceleration  of  the  joint  variables,  and 


q(t)    is  an  nxn  inertial  acceleration  related  symmetric  matrix  whose  elements  are: 

n 
aik=    I  Tr(UAAJ^U^),     i,*=l,2v..,ri  (2.24) 

A=max(i,fc) 
When   i=k,  a-  is  related  to  the  acceleration  of  joint  i  where  r-  acts  and  is  known  as 

effective  inertia.  When  #Ar,  a,  is  related  to  the  reaction  torque  induced  by  the  acceleration 

of  joint  /rand  acting  at  joint  i  (known  as  coupling  inertia),  and 


V 


q(t).q(t) 


rV 

1 

V 

•  2 

V 

n 


is  an  nxl  velocity  re  lated  vector  composed  of  Coriolis  and 
centrifugal  forces,  where 

n    n 
k=ll=l 


(2.25) 


and 


n 


v  •, 


Tr(UAyt/jjJ  UA^)  ,  i',M=l,2,...,n 


(2.26) 


ikl~    1 

\=max(i,k) 

When  fc=/,  the  velocity  torques  are  known  as  centripetal  torques,  and  when  ftfl  as  Coriolis 
torques.  Friction  torques  are  also  velocity  related  and  can  be  added  to  this  term  as: 


fr=Csgn(q  ■)  +  Vq. 


where 
C  is  a  coulomb  friction  constant, 
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V  is  a  viscous  friction  constant  and, 
sgn  is  the  sign  function,  and 


G 


q(t) 


?2 


g 
n 


is  an  nxl  gravity  loading  force  vector,  where, 


n 

A 


A=i 

The  dynamic  equations  of  motion  as  given  by  equation  (2.24)  are  coupled,  nonlinear, 

second  order,  ordinary  differential  equations.  Notice  also  that  equation  (2.24)  yields  the 
solution  of  the  inverse  dynamics  problem.  For  every  point  (q(t),q(t),q(t))  of  a  given 
trajectory,  it  yields  the  required  joint  torques  vector  t.  This  form  allows  design  of  a  control 
law  that  easily  compensates  for  the  nonlinear  effects.  Computationally,  however,  these 

equations  are  extremely  inefficient  as  they  require: 

,    ,128x  4   ,   ,512x  3   .   /844x  2   .   ,76x         u.  ,.     ..  , 

1.  (-ir-)n    +  (-o-)w    +  {-~T~)n    +  \-i)n  multiplications,  and, 

0   ,98^  4   ,    ,78K   3       /637x   2   .    ,107*      AA... 

2.  {-o)n    +{-*-) n    +  [-o-)n   +  (~T") n  additions. 

for  every  set  point  in  the  trajectory.  That  is,  they  are  of  0(w4)  order  of  complexity,  where 
n  is  the  number  of  links. 

There  are  two  categories  of  approaches  in  trying  to  implement  the  closed— form  Lagrange 
equations  in  real  time  control  applications: 

1.  Simplifying  the  dynamics  by  ignoring  the  least  significant  terms  and  correcting  errors 
with  some  feedback  compensation.  The  simplifying  assumptions,  however,  may  not  hold 
for  all  speeds  and  all  ranges  of  applications. 

2.  Precomputing  terms  in  the  equations  and  using  a  gain  scheduling  approach. 

C.   RECURSIVE  LAGRANGIAN  MANIPULATOR  DYNAMICS 

The  main  reason  for  the  inefficiency  of  the  Uicker/Khan  formulation  is  due  to  the  fact 
that  these  equations  are  closed— form  expressions  and  most  of  the  terms  are  reevaluated 
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many  times.  To  reduce  the  complexity  of  these  equations,  we  need  to  reexamine  the  above 

derivation  and  recast  it  into  a  recursive  form  which  is  computationally  more  efficient  [66]. 

The  generalized  driving  torques  given  in  equation  (2.22)  can  be  expressed  as: 

n 

i=l,2,...n  (2.28) 


*r  I  [Tr(uA,JA*I)  -  ™a6ua,pa 


X=i 


where  T,  is  defined  as: 


A  A    A 

fX  =    I  UA A+  I    I  V\kWl  <2-29) 

*=1  k=ll=l 

The  advantage  of  the  above  substitution  is  that  equation  (2.29)  is  never  used  in  the 
computation.  More  efficient  recurrence  relations  for  the  velocity  T*  and  acceleration  T» 
are  easily  derived  by  straightforward  differentiation: 

TA  =  TA_1T^~1  (2.30) 

*A  =  Va"'  +  TX-A~l 

TA  =  rrA-lTA_1  +  TA-1UAA^A  (2-31) 

TA  =  ^X-A^^X-A^^X-^XX^X^X-^XX^X^X-^XX^X 

fX  =  fX-lTi~1  +  2tA-lUAA«A  +  TA-1UAAA^A  +  TA-1UAA«A  <2-32) 

Computing  the  driving  torques  as  given  by  equation  (2.28),  and  using  the  recursive 

relations  in  (2.30),  (2.31).  and  (2.32),  results  in  an  0(n2)  order  of  complexity,  requiring: 

19  1 

1.  106  xTi   +  620  cyn  -  512  multiplications,  and, 

2.  82»2  +  514n  -  384  additions. 

The  reduction  in  complexity  comes  from  the  fact  that  to  calculate  coriolis  and 
centrifugal  forces,  we  only  need  to  calculate  U » » ,  instead  of  all  the  matrices  U » ,  * 

Further  computations  can  be  saved  by  noting  that: 

UA!  =  UflTJ[  (2.33) 

Therefore. the  generalized  torques  equation  (2.28)  can  be  written: 
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or 


where 


n 

\=i 

n  n 

X=i  X=i 


Ti  =  Tr<JJip)-&fpi  (2.35) 


n 

Dr    XTAJA*A 

\=i 


Di  =  T!JiV    IT!+1TA     JAfA 

A=»+l 


D  =  JZTT  +  T'.tD.,,  (2.36) 


and 


n 

Gi=  lmxT'xPXx 

X=i 

Ci=md+TllCi+l  (2-37> 

These  recursive  relations  can  be  computed  as  follows: 

For  i  =  1,2,... n 

1.  compute  T.  by  equation  (2.30) 

V 

2.  compute  T-  by  equation  (2.31) 

3.  compute  T  •  by  equation  (2.32) 

4.  if  i  =  7i,  continue.  Otherwise,  set  t^i+1  and  return  to  1. 

5.  compute  D  by  equation  (2.36) 

6.  compute  C  by  equation  (2.37) 

7.  compute  r-by  equation  (2.35) 

8.  if  i—  1,  stop.  Otherwise,  set  »=t— 1,  and  return  to  5. 
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The  advantage  of  this  formulation  is  that  its  complexity  is  now  0(n).  It  requires: 

1.  83071  -  592  multiplications,  and, 

2.  675n  —  464  additions. 

Any  other  reduction  in  computational  complexity  can  only  be  obtained  by  reducing  the 
size  of  the  coefficients  in  the  above  complexity  polynomials  [67] .  This  can  be  achieved 
through  reformulating  the  Lagrangian  dynamics  in  terms  of  3x3  rotational  matrices  rather 
than  4x4  rotation-translation  matrices.  Because  3x3  matrix  multiplications  require  27 
multiplications  while  4x4  matrix  multiplications  require  64,  we  get  a  greater  than  50% 
reduction  in  the  coefficients  of  the  computational  cost  terms. 

The  matrix  T-       relating  the  orientation  of  the  coordinate  system  i— 1  and  i  is  now 

2—1 

reduced  to  a  3x3  rotation  matrix  R      .  A  point  on  link   i,  expressed  in  homogeneous 


th  i 

coordinates  with  respect  to  the  i     coordinates  frame,  is  now  represented  as  p 


i 


with  p   the  same  point  with  respect  to  the  base  coordinate  frame.  The  following  sets  of 


vectors  are  also  needed  throughout  this  derivation 


?  th 

&■,  the  joint  i  coordinate  origin  expressed  in  the  j    coordinates  frame,  and, 

7  th 

cj,  the  link  i  center  of  mass  expressed  in  the  j    coordinates  frame. 

The  quantities,  p  .  o  and  pi  are  related  by: 


P,  =  o,  +  T  .p|  (2.38) 


The  velocity  of  p  is  then  given  by: 


P,  =  \  =  6i  +  T,p!  <2-39> 

and  the  kinetic  energy  for  a  particle  on  link  %  is  as  given  earlier: 

dki  =  £Tr(v.vT)dm  (2.40) 


33 


Integrating  over  all  particles  in  link  i,  the  total  kinetic  energy  K  ■  of  link  i  is  given  by: 

Ki  =  \  TK»^  +  *Tffa  +  T,JJTT)  (2.42) 

where 

nj.=  /pjdm  (2.43) 

Therefore,  the  total  kinetic  energy  for  all  the  links  is  given  by: 

n 

K  =  ll  TrK6A6I  +  2TAnA6I  +  TAJATP  (2-44) 

A=l 


and  the  potential  energy  becomes: 


n 

A 


P  =     I   mxgTxvAx  (2.45) 

A=l 
Proceeding  as  in  the  homogeneous  coordinate  formulation,  we  can  write  the  Lagrange 

equations  for  each  link  as: 

d    dK         OK       d?  ,0,ftx 

rroTT--— +  —  (2-46) 

dqt        5q-      dqt 

which  take  into  account  the  fact  that  the  potential  energy  depends  on  position  only. 
Performing  the  differentiation  and  rearranging  terms  yields: 


do,        do 


u=  I  [Tr^A^^^^T^uA^4^uA^JAT^-AgTAPA 


(2.47) 


Recall  that 

oA  =  o,.+  T,o«  (2.48) 

do, 

T7  =  VA  <2-49> 

UAi  =  UaTJ[  (2.50) 

Substituting  the  above  relations  into  equation  (2.47),  we  obtain: 

n  n 

T^S  I  (mAoj[»J+oj{nj^J+TJ[.j|«J+Tj{jj^[))-gaa  J  «AT«pj|  (2.51) 


34 


or 

rj.  =  Tr(U!!Dl.)-gU.-C!  (2.52) 

where 

n 

has  the  same  structure  as  equation  (2.37),  except  for  the  difference  in  dimensionality.  For 

the  term  D  -,  we  can  write  the  recurrence: 
i 

n 
D.  =     I  {mxo]ol  +  o{n*TTJ  +  T*n^J  +  Tjftft) 
A=i 

°r  i  <  (T;+iori+o;:+i)(mA°i+nATTi)+T;:+1Ti+1(^oi+JiTp)+„;oT+J;:Tr 

A =i+l 
DrT;+1D,+  1  +  o|+1ei+1n!oT  +  J^T  (2.54) 

where 

n 

er  ^-a5I  +  dattP 

A=?" 
e=e.^,  +  moT  +  n^T*  (2.55) 

Z  2-1-1  2    2  2        Z  v  ' 

The  T\  term  also  has  the  same  recursive  expression  as  defined  earlier  in  equation  (2.32), 
though  presently  referring  to  a  3x3  rotation  matrix.  The  6»  term  is  given  by: 

This   formulation   decreases   the  complexity  polynomial   of  the  recursive  Lagrangian 
formulation  with  4x4  matrices  by  more  than  50%.  It  requires: 

1.  41272  -  277  multiplications,  and 

2.  320n  -  201  additions. 

This  translates  into  2.195  multiplications  and  1,719  additions,  for  a  six  degrees  of  freedom 
manipulator,  which  is  well  within  the  capacity  of  today's  microprocessors. 
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D.   RECURSIVE  NEWTON-EULER'S  MANIPULATOR  DYNAMICS 

Another  possible  formulation  of  the  equations  of  motion  is  based  on  the  Newton— Euler 

approach.  While  the  Lagrangian  dynamics  were  reworked  with  some  effort  into  an  efficient 

recursive  form,  this  method,  naturally,  yields  a  set  of  recursive  equations  which  can  be 

applied   to  the  links  sequentially  reducing  the  computational  burden  to  its  minimum 

possible. 

In  this  derivation,  each  link  is  considered  as  a  free  body  accelerating  in  space  and 

obeying  Newton's  second  law  of  dynamics  for  linear  movement  and  Euler's  equation  for 

angular  rotation. 

Using  the  same  notation  as  previously  defined,  the  vectors  o   (joint's  i  coordinate  origin 

V 

expressed  in  the  base  coordinate  frame),  o  (joint's  i  coordinate  origin  expressed  in  the 
(i—  1)  coordinate  frame),  and  o  _,  (joint's  (i—  1)  coordinate  origin  expressed  in  the  base 
coordinate  frame)  are  related  by: 

°i = °m  +  °Tl  <2-57> 

If  v_,  and  w-  ,  are,  respectively,  the  linear  and  angular  velocity  of  the  coordinate 
system  {x-py-pZ-j)  with  reference  to  the  base  coordinates,  then  the  velocity  of 
coordinate  system  {z-,y-,z-)  with  reference  to  the  base  coordinates  is: 

dor1       _i 

v,  =  ar-  +  Vix°n  +  Vi  (2-58> 

Thus  the  acceleration  is  given  by: 

d2°r1      •  i      d°rl         -i 

^ri^- fW^-ix°r  +2w2-ixoT— +wi-i(wf-ixoi   )+Vi  (2-59^ 

do-  -j 

in  which  2w-  ,xtt is  the  Coriolis  acceleration,  w-  ,(w-  ,xo-     )  is  the  centrifugal 

i—\  at  i—  lv    i— I     i     '  ° 

acceleration  and  x  denotes  external  product  of  vectors. 

The  angular  velocity  of  the  system  (x-,y-,z)  with  reference  to  the  base  w.  and  its  angular 
velocity  with  reference  to  the  ( j- 1)     coordinate  frame  w*.     are  related  by: 

V 
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and 


But, 


Hence  (2.61)  becomes: 


wt  =  WM  +  w"  (2-6°) 


*!=vi+*ri  (2-61) 


*"  =  ar-  +  wMxwr  (2-62) 


^r1      w 

*,■  =  *i_i  +  3T1-  +  w^,™r  (263) 


z         i— l      dt  z— l      i 

Since  an  angular  motion  of  link  i  is  about  the  z-  ,  axis,  then, 
°  z— l 


■  ,       r  #.    r9-       if  link  z  is  rotational 
w _1  =       ?_7  *  (2.64) 

*  0  if  link  z  is  translat  ional 


Thus. 

t-l 

i  I  ~i— i*z 

0  if  link  z  is  translat  ional 

Combine  (2.60).  (2.63),  (2.64),  and  (2.65)  to  yield: 


dw  (  z ■    /<7-       if  link  z  is  rotational 

3F-=      '  ......  ,  ,  <2'65» 


w-    ,  +  2-    ,^-       if  link  z  is  rotational 
w-=        l~1        l~J  l  (2.66) 


w_?  if  link  z  is  translat  ional 


and 


(2.67) 


w  _  f+z-    /<7-+w  ■_  ,x(z-_  .</•)  if  link  i  is  rotatational 

ll  111  11  111 

1  w  .    ,  if  link  z  is  trans  1  at inal 

Returning  to  equations  (2.58)  and  (2.59),  we  note  that  if  link   i  is  translational  in 
coordinates   {x_vy-_vz-_1),   it   travels  in  the  direction   z-v  with  joint   velocity  q, 

I       I        I       1       I        L  11  I 

relative  to  link  i—1.  If  it  is  rotational  in  coordinates  [x_vy_vz_X  it  has  an  angular 

t— 1 

velocity  w-     .  Thus, 

I 

i—\  i—1     i—1 

do-  (  w-       o-         if  link  z  is  rotational 

3T—  =        '  '  (2-68) 

1  2-    fo-  if  link  z  is  translat  ional 

i-lHi 
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w-1 


A      i'1 

i  i—1      i—1       i—1     i—1 

-xi xo-     +w-     x(w-     xo      )  if  link  i  is  rotational 

d  t  i  i       K    i         i     ' 


(2.69) 


z-     i'q-  i  f  link  i  is  translational 

Combine  equations  (2.60),  (2.63),  and  (2.68)  to  yield: 

fw.xo-         +    y_i  if  link  i  is  rotational 

vi=  i-1  (2-7°) 

[  z  ■    /a  ■   +    w  xo        +v-    ,  if  link  us  translational 
i—lH  i  i      i  i-l 


wr 


(2.71) 


WXO-  +     WXW-XO-  )  "+  V  ■       i        -r     i-     i 

ii  i    v     i      %      '  i  -1     if  link   i  is 

rotational 

i—1 

Z  ■      /<7  ■      +     WXO-  +   2  W  -X  (  2  •       f  0  •) 

•     i  i  f  1  ink   %  l s 

+  wx(wxo-      )    +   v-     f  translational 

L         ?    v      i        i      '  i- 1 

Equations  (2.66),  (2.67),  (2.70),  and  (2.71)  describe  the  recursive  relations  of  velocities 

and  accelerations  between  link  i—1  and  i.  To  derive  the  dynamic  motion  of  the  mechanical 

manipulator  from  the  above  kinematics  information,  each  link  is  considered  as  a  free  body 

accelerating  in  space  and  obeying  Newton's  second  law  of  dynamics: 

d(miV) 
F-  =  — -r-t — -   =  m-a      ,  for  linear  movement,  (2.72) 

Z  CI  L  Z    C  • 

i 
and  Euler's  equation: 

d(I,-w.) 
i         dt  ii        i  v  i 

where, 
F-  is  the  total  external  vector  force  exerted  on  link  i  at  the  center  of  mass  c-, 

v    =  -T—  is  the  linear  velocity  of  the  center  of  mass  c-  of  link  i, 
i 

a^  ==  -n —  is  the  linear  acceleration  of  the  center  of  mass  c  ■  of  link  i, 
c-      dt  i 

i 

N  •  is  the  total  external  vector  moment  exerted  on  link  i  at  the  center  of  mass  c-,  and 
i  v 

I  ■  is  the  inertia  matrix  of  link  i  about  its  center  of  mass  c  •  with  reference  to  the  base 
i  i 


7      ? 

N-  =  — -rr =  Iw  +  w  x(I.w-),  for  angular  rotation  (2.73) 


coordinates  system. 
The  other  variables  are  as  defined  earlier. 
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The  quantities  w  •  and  w  •  can  be  computed  from  (2.66)  and  (2.67),  while  v     and  a     can 

c,-  C- 

i  i 

be  derived  from  (2.58)  and  (2.59)  as  follows: 

Replace  o ■      by  c   ,  o  by  c  ,  and  note  that  since  both  (x-,y-,z)  and  c*  are  fixed  on  link  i, 

till  X     %     %  % 

dO2"1        d20M 

Consequently,  the  equations  describing  v    and  a    are: 

vc  =  wMxoi~1  +  Vl  (2'74» 

The  total  external  force  F  •  and  moment  N  •  are  those  exerted  on  link  i  by  gravity  and 
neighboring  links,  that  is, 

F,=f,-fi+i  (2-76> 


N 


i  =  n;  -".+  !  +  (°i  -  S'^r  (oi+l  -  ci)xfH-l 


*,  =  »,-■*! +  (0,-^-05  lxf!+i  <2-77) 


where 


f  ■  is  the  force  exerted  on  link  i  by  link  i  —  1,  and 

n  •  is  the  moment  exerted  on  link  j  bv  link  i  —  1. 
i 

Since  c-  -  o  _ ,   =  o ■      +  c-,  equations  (2.76)  and  (2.77)  can  be  expressed  in  recursive 
relations  as 

f!  =  f!+1  +  Fi  (2.78) 

ni  =  Vl  +  <l  xf<+l  +  ^P1  +  CK  +  N,  (2-79) 

According  to  the  convention  for  establishing  link  coordinate  systems  for  a  mechanical 

manipulator,  the  motion  of  link  i  may  only  be  either  a  rotation  in  the  coordinate  system 

{x_  i-y  _  i-z_  i)  about   z-1  axis,  or  a  translation  relative  to  the  coordinate  system 

(xi-  vVi-  vzi- 1)  ai°ng  z_  y  Therefore,  if  the  joint  i  is  rotational,  the  input  torque  t  at 

lllj.ll  11  C 

that  joint  is  the  sum  of  the  projection  of  n   onto  the  z-_1  axis  and  the  viscous  damping 

I  it 
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Ti= 


(2.80) 


moment  in  that  coordinate  system.  If,  however,  the  joint  i  is  translational,  the  input  force 
t-  at  that  joint  is  the  sum  of  the  projection  of  f-  onto  the  z-_1  axis  and  the  viscous 

o  111 

damping  force  in  that  coordinate  system.  That  is, 

nXz-    <  +  b-fl.      if  link  i\s  rotational 
i  i—l         VI 

i\z-    i  +  b'q-      if  link  t  is  translational 
where  b  ■  is  the  viscous  damping  coefficient  for  joint  i. 

In  summary,  the  complete  set  of  equations  of  motion  for  the  mechanical  manipulator 
with  n  joints  and  n+1  links  consists  of  equations  (2.66),  (2.67),  (2.70)  through  (2.75)  and 
(2.78)  through  (2.80)  for  i=l,2,...,n.  Unfortunately,  because  these  equations  are  referenced 
to  the  base  coordinate  systems,  the  inertia  matrix  I.  is  dependent  on  the  changing 
orientation  of  link  i,  which  complicates  the  computation.  A  more  efficient  technique  for 
computing  the  joint  input  forces  and  torques  is  to  have  each  link's  dynamics  referenced  to 


its  own  link  coordinates  [68].  This  may  easily  be  achieved  using  the  rotation  matrix  R 


i-\ 


defined  earlier  and  noting  that  since  each  coordinate  system  is  orthogonal,  then: 


(RJ-1)      =  (RpV 


R 


2-1 


(2.81) 


Instead  of  computing  w-,  w-,  v.,  a   ,  F-,  FT,  T,  n.,  and  r-,  compute  R  w^,  R  w-,  R  v.,  R  a    , 

i  i 

R?F ,  R?N  ■.  Rzf ,  R*n .,  and  Rr.  Hence  the  complete  set  of  equations  of  motion  becomes: 

Ctll  c 

,i-l 


Rw.  = 


R-    ,(R      w-    t  +  Zf,q)       if  link   i   is 
i-ly  i-l        0V        «*«+•«  „i 

rotational 


(2.82) 


IR*    JRl    1vf.    f) 
L     i-lx  i-l' 


if  link   i  is 
translational 


Rw  = 


rotational 


(2.83) 


Rl    JR1    7w.) 
i-r  %' 


if  link  %   is 
translational 
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*v 


(R^.JxtR'o)     ')    +  R^^R1'-1*.      ) 


! 


i  _  i  - 1 


+    (Rlwi)x[(Rwi)x(R(o! 


)] 


if  link   i  is 
rotational 


+    2(R,"wt.)x(R{_Jfjr0^.)  +  (R,'w.) 

x[(R,w.)x(R,'oj    "')] 


if   link   i   is 
trans  1  at  ional 


,? 


,2„2n 


,1 


,Z 


,  2„2> 


R'ac  =  (Rfw.)x(R4c;.)  +  (R'w.)x[(RV)x(R<c;.)]  +  R'v 
z 

R*F  =  m.R'a 
i         i      c 

Z 

R*N.=  (R?I.Rz)(rV)  +  (RV)x[(RzIR2)(RV)] 


R?f  .=  R' 

i         z+1 


(Rz+1f.xl)  +  R?F, 


R?n  =  R*       [R*  +  1n  ... 
z  z  +1  L  i+l 


+(Ri+1o|-1)X(Ri\1)] 


+    (Rzo<    1+R*c|)x(R,'f.)+(R,"n.) 


ti  = 


(2.84) 


(2.85) 

(2.86) 

(2.87) 
(2.88) 
(2.89) 


(2.90) 


(R  n  )T(R_  rjzu)  +  b  •</•  if  link  z  is  rotational 

7  7 

(R  f  )T(R_  ;zn)  +  b<7-  if  link  i  is  translat  ional 
This  formulation  gives  a  60%  reduction  in  computation  over  the  recursive  Lagrangian 
formulation.  It  requires: 

1.  15071  —  48  multiplications,  and 

2.  131  n-  48  additions. 


E.   CONCLUSIONS 

In  this  chapter  alternative  formulations  for  deriving  the  equations  of  motion  of  serial 
link  manipulators  have  been  described.  The  emphasis  has  been  put  on  real  time 
computational  complexity  in  terms  of  required  mathematical  operations  per  trajectory  set 
point.  One  should  not,  however,  be  misled  by  the  fact  that  in  the  above  development,  the 
recursive  Newton— Euler  equations  are  almost  three  times  more  efficient  than  the  recursive 
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Lagrangian  equations.  The  discrepancy  between  the  two  formulations  is  due  to  the 
difference  in  the  angular  velocity  vector  representation  used  by  each  method.  In  the 
Newton— Euler  formulation,  the  angular  velocity  is  adequately  represented  with  a  3x1 
vector  w  ■,  whereas  in  the  Lagrangian  formulation,  it  is  redundantly  represented  with  a  3x3 
matrix  !)■>  A  factor  of  three  in  the  relative  efficiency  of  the  two  formulations  is  therefore 
to  be  expected.  The  redundancy  in  the  angular  velocity  representation  is  manifested  in  the 
rotational  kinetic  energy  expression.  For  the  3x3  representation,  the  rotational  kinetic 

energy  is  as  derived  in  equation  (2.15): 

r      i  i 

T 


K 


1 


Tr 


i  % 

A=l  k=\ 

whereas  for  the  3x1  representation,  the  rotational  kinetic  energy  is: 

K  •  =  oW  I  .w 

i      2    ii     i 


(2.91) 


Using  this  new  representation  of  the  rotational  kinetic  energy,  the  complete  generalized 
force  expression  r  •  in  the  Lagrangian  equation  (2.22)  changes  to: 


=   1  [mx^+h^Tr  +  h*\  +  wax^awa)1-t: 


dwx, 


A=z" 


Oq 


5q, 


(2.92) 


or 


"  8c 


dwx, 


dq4 


A' 


8q 


(2.93) 


X  =  i       "*-t 

where  f»  represents  the  net  force  in  Newton's  equation,  and  n,  represents  the  net  torque  in 

Euler's  equation. 

Therefore,  contrary  to  what  might  have  appeared  earlier,  there  is  no  difference  in  the 
computational  complexity  of  dynamics  formulations  derived  from  the  Newton— Euler 
equations  or  the  Lagrange  equations.  The  recursive  Newton— Euler  equations  are  no  more 
efficient  than  the  recursive  Lagrangian  equations  as  long  as  the  same  representation  of 
angular    velocity    is    used.    Moreover,    the   Newton-Euler   equations    would    become   as 
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inefficient  as  the  original  Uicker/Kahn  equations  if  they  were  expressed  in  closed  form. 

Consequently,  the  emphasis  on  computational  complexity  or  on  advanced  control 
strategies  synthesis  should  rest  on  the  structure  of  the  computation  rather  than  on  the 
derivation  from  Lagrange  versus  Newton— Euler  equations. 

In  addition,  the  designer  will  probably  need  both  structures  of  the  dynamic  equations 
and  more  than  one  method  of  obtaining  these  equations  throughout  the  different  phases  of 
the  design  process.  He  will  need: 

1.  A  closed  form  expression  of  the  manipulator  dynamics  in  the  early  stages  of  the  design 
process  in  order  to  be  able  to  synthesize  adequate  control  laws, 

2.  More  than  one  method  of  deriving  the  system  dynamics  equations  in  the  computer 
simulation  phase  in  order  to  be  able  to  compare  the  solution  obtained  by  different 
methods  and  place  greater  confidence  on  the  simulation  program,  and 

3.  A  recursive  form  expression  of  the  manipulator  dynamics  when  implementing  the 
chosen  control  law  in  real  time. 
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HI.  ADAPTIVE  CONTROL  FOR  MECHANICAL  MANIPULATORS 

A.  INTRODUCTION 

The  problem  of  controlling  articulated  mechanical  systems  such  as  manipulators  using 
conventional  control  methods  is  very  difficult  when  high  speed  and  high  accuracy 
operations  are  desired.  The  difficulty  arises  from  the  fact  that  such  linkages  are 
characterized  by  highly  nonlinear  and  coupled  ordinary  differential  equations.  Closed  form 
analytical  solutions  to  these  differential  equations  are  not  available.  Instead,  they  must  be 
solved  by  numerical  integration  on  a  digital  computer,  which,  on  the  other  hand,  imposes  a 
serious  limitation  on  the  number  of  calculations  that  can  be  performed  in  real  time. 

The  problem  becomes  even  more  difficult  when  the  plant  parameters  are  not  precisely 
known  and  vary  in  time,  as  in  most  robotics  applications.  Furthermore,  a  joint  angles  to 
end  point  coordinates  matrix  transformation  are  usually  required  in  such  systems,  which 
increases  the  burden  on  the  computing  machine. 

To  maintain  good  performance  over  a  wide  range  of  motions  and  payloads,  researchers 
have  turned  to  adaptive  control  methods  for  their  ability  to  adjust  to  parameters 
uncertainties  and  load  disturbances.  Unfortunately,  most  of  these  methodologies  are  not 
computationally  efficient.  As  we  have  indicated  in  Chapter  1,  two  approaches  to  adaptive 
control  theory  can  be  found  in  the  literature. 

In  the  Model  Reference  Adaptive  Control  scheme,  the  manipulator  dynamic  model  is 
not  directly  used  in  the  design  so  that  the  on  line  solution  of  differential  equations  is  not 
required  in  the  implementation.  The  manipulator  is  controlled  by  adjusting  position  and 
velocity  feedback  gains  to  follow  a  prescribed  reference  model. 

In  the  Learning  Model  Adaptive  Control  method,  a  model  of  the  plant  is  obtained  by  on 
line  parameter  estimation  techniques.  This  estimated  model  is  then  used  in  the  feedback 
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control.  For  reasons  of  computation  efficiency,  most  of  the  techniques  in  this  category  are 
based  on  linearized  models  of  the  manipulator  which  constrain  the  range  of  validity  and  of 
acceptable  performances.  Our  main  focus  in  this  chapter  will  be  to  develop  an  algorithm  for 
the  Model  Reference  Adaptive  Control  of  mechanical  manipulators. 

In  the  next  section,'  we  will  formulate  the  dynamic  equations  for  mechanical 
manipulators  in  state  space.  This  representation  is  more  suitable  for  analyzing  the 
performances  of  such  methodologies.  We  will  also  give  a  detailed  derivation  of  the  state 
space  equations  of  a  two  link  arm  model  for  illustration. 

Section  three  will  review  some  leading  adaptive  control  methods.  These  techniques  will 
be  simulated  on  the  two  link  model  using  IBM/DSL  [69].  We  will  compare  their 
performances  and  point  out  some  of  their  advantages  as  well  as  some  of  their  limitations. 
The  aim  is  to  show  where  the  need  for  better  adaptive  control  strategies  is  felt. 

In  section  four,  a  novel  adaptive  control  law  which  guarantees  global  stability  and  yields 
better  performances  is  synthesized.  A  rapprochement  between  this  method  and  the  Model 
Reference  Adaptive  Control  methodologies  is  also  established. 

Section  five  summarizes  the  main  results  obtained  in  this  study  and  outlines  some  areas 
for  future  research. 


B.   MECHANICAL  MANIPULATOR  DYNAMICS  IN  TERMS  OF  STATE  VARIABLES 
The  standard  inverse  dynamics  equations  describing  a  mechanical  manipulator  are  given 
in  equation  (2.24)  of  Chapter  2  and  are  reproduced  here  for  convenience. 


r(t)  =  A 


q(t) 


q(t)  +  V 


q(t),q(t) 


+  G 


q(t) 


These  equations  can  be  rewritten  as: 


q(t)  =  A-i 


q(t) 


q(t),q(t) 


-G 


q(t) 


(3.1) 


(3.2) 


r(t)-V 

In  order  to  be  able  to  gain  better  analytical  insight  to  the  control  system  design,  it  is 
convenient  to  rewrite  equation  (3.2)  in  terms  of  state  variables. 
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Naturally,  if  one  has  no  particular  reason  for  other  choices,  the  state  variables  and  the 

input  control  vectors  are,  respectively,  defined  as: 

'q(t)" 


Xp«  - 


U(t)J 


Up(t)  =  r(t) 
where, q(t),  q(t)  and  r(t)  are  as  defined  earlier  in  Chapter  2. 


In  addition,  the  vectors  V 


q(t),q(t) 


and  G 


q(t) 


can  be  expressed  as: 


q(t),q(t) 


G 


q(t) 


=  Vi 


=  G, 


q(t),q(t) 


q(t) 


q(t) 


q(t) 


Therefore,  equation  (3.2)  can  be  rewritten  as: 


Xp(t)  =  Ap(Xp(t),t)Xp(t)  +  Bp(Xp(t),t)Up(t) 


where 


Ap(Xp(t),t) 


o  : 


q(t) 
q(t)J 

In 


[A-i(q(t))G1(q(t)):-A-i(q(t))V1(q(t),q(t))J 

0 


Bp(Xp(t),t)  = 


LA-Hq(t)) 


Here  In  is  the  identity  matrix  of  order  n. 


The  matrices  Vi 


q(t),q(t) 


and  Gi 


q(t) 


are  found  as  follows: 


Notice  that  the  expression  of  V 
rewritten  as: 


q(t),q(t) 


(3.3) 
(3.4) 


(3.5) 
(3.6) 

(3.7) 

(3.8) 

(3.9) 

(3.10) 


given  in  equation  (2.22)  of  Chapter  2  can  be 


V 


q(t),q(t) 


V2 


q(t) 


q(t) 


(3.11) 


where  V3 


q(t) 


is  given  by: 
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v3 


q(t) 


and  Vo 


q(t) 


q  (t)q  (t) 

•  1  Q 

q  (t)q  (t) 

•  n  1 

q  (t)q  (t) 

n  n 


is  a  matrix  containing  all  the  remaining  terms  of  V 


q(t),q(t) 


V3  q(t)    can  be  expressed  as: 


V3 


q(t) 


q(t) 


with 


q^Oq^t) 

qi(t)q2(t) 

q  (t)q  (t) 

•  1  n 

q  (t)q  (t) 

•  n  1 

q  (t)q  (t) 

n  n 


q  (t)  0  .  .  0 

0        q(t)  0...   0 
1 


q(t) 


V, 


q(t) 


Therefore, 


Vi 


q(t),q(t) 


0        0 

q(t)  .. 

•  n 

0        0 

=  v2 


q(t) 


0 

q(t) 

n 

q(t) 


To  obtain  Gi  q(t) 


,  let 


G, 


q(t) 


llG[q(t)Hl 
II     q(t)ll 


q(t) 


(3.12) 


(3.12) 


(3.13) 


(3-14) 
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g] 


q(t) 


Hence, 


G! 


q(t) 


=  H 


G[q(t)]  -  Gi[q(t)] 
||G[q(t)]  -  Gj[q(t)]|| 

ll|G[q(t)]|| 


(3.15) 


Gi 


q(t) 


where  ||.||  is  the  Euclidean  norm  of  a  vector  and  H 
[70]  defined  as: 


H 


u 


I-2.U.U* 


(3.16) 
q(t)  II 

is  the  Householder  transformation 


(3.17) 


C.   SIMULATION  STUDY  OF  SOME  ADAPTIVE  CONTROL  METHODS 

In  the  remainder  of  this  chapter,  a  two  revolute  joints  arm  model  is  considered.  This 
model  is  shown  in  Figure  3.1.  The  equations  of  motions  of  this  mechanical  system  are 
derived  in  detailed  in  the  Appendix.  Based  on  this  model,  a  new  adaptive  algorithm,  as 
well  as  some  of  the  strategies  presented  in  Chapter  1,  are  studied  here  in  more  detail. 
Considered  are  the  inverse  dynamics  control  technique,  the  variable  structure  control 
approach,  the  model  following  strategy  and  the  perturbation  control  theory.  The  basic  idea 
behind  all  these  methodologies  is  to  synthesize  a  control  input  r  which  will  force  the  robot 
to  follow  the  output  of  a  reference  model.  The  behavior  we  are  concerned  with  here  is  the 
tracking  in  real  time  of  desired  trajectories.  The  reference  model  can  be  either  a  stable 
linear  time  invariant  decoupled  system  as  in  the  Adaptive  Linear  Model  Following  Control, 
or  a  combination  of  models  such  as  in  the  Variable  Structure  Control,  or  a  nonlinear 
nominal  model  of  the  plant  as  in  the  inverse  dynamics  control  and  the  perturbation  theory. 
1.   Inverse  Dynamics  Technique 


In  this  technique,  the  control  input  U  (t)  is  chosen  as: 


Up(t)=A 


q(t) 


qd(t)+Kve(t)+Kpe(t)(+V 


q(t),q(t) 


+G 


q(t) 


(3.18) 
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Figure  3.1 :  Atwo  link  Mechanical  Manipulator 
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where    A 


q(t) 


,    V 


q(t),q(t) 


and    G 


q(t) 


are  some  estimates  of  A 


q(t) 


,  V 


q(t),q(t) 


and  G 


q(t) 


,  respectively. 


This  control  law  consist  of  two  basic  loops: 


1.  A  feedforward  component: 


V t}  - 


q(t) 


qd(t)  +  V 


q(t),q(t) 


+  G 


q(t) 


This  component  is  based  on  a  dynamic  model  of  the  manipulator.  It  compensates  for 
the  interaction  forces  among  various  joints. 


2.  A  feedback  component: 


Upb(t)  =  A 


q(t) 


Kve(t)  +  Kpe(t)|, 


This  component  is  based  on  position  and  derivative  feedback.  It  computes  the  necessary 
correction  torques  to  compensate  for  any  deviations  from  the  desired  trajectory. 

Among  the  attractive  features  of  this  method  is  the  fact  that,  in  principle,  it  turns  a 
nonlinear,  coupled  mechanical  system  into  a  linear,  decoupled,  and  stable  system.  This  can 
be  seen  by  substituting  the  above  torques  expression  of  equation  (3.18)  into  equation  (3.1) 
to  obtain: 


Aq  +  V  +  G  =  A{qd  +  Kve+K  ej  +  V+G 

where  the  arguments  have  been  omitted  for  convenience. 
If  A  =  A.  V  =  V  and  G  =  G,  equation  (3.19)  reduces  to: 


(3.19) 


q(t) 


|e(t)  +  Kye(t)  +  Kpe(t)}  =  0 


(3.20) 


Since  A 


q(t) 


is  always  nonsingular,  K    and  K    can  be  appropriately  chosen  so  that  the 


position    error    vector   e(t)    approaches    zero   asymptotically.    This    control    strategy    is 
simulated  on  the  two  arm  model  presented  earlier.  The  desired  trajectories  are  chosen  as: 


qd(t)  =  270t2-180t3 
l 

q<*(t)  =  45  +  270t2-180t3 

2 


(3-21) 
(3.22) 
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These  trajectories  are  shown  in  Figures  3.2  and  3.3.  The  gain  matrices  K    and  K    are 
chosen  as: 


'100 

0  " 

K  = 
P 

0 

100 

"20 

0  " 

K    = 

V 

0 

20 

(3.23) 


In  this  case,  where  we  assume  complete  and  exact  knowledge  of  the  manipulator  dynamics, 
we  obtain  perfect  tracking  of  the  desired  trajectories.  This  can  be  seen  in  Figures  3.4  and 
3.5,  where  the  actual  trajectories  (q,  and  q9)  and  the  desired  trajectories  (q,  and  q9)  are 
virtually  indistinguishable  with  the  tracking  errors  (e,  and  e9)  shown  in  Figure  3.G.  Also 
the  magnitudes  of  the  torques  applied  at  the  joint  actuators  are  bounded  with  reasonable 
values  as  shown  in  Figure  3.7. 

The  main  drawback  of  this  method  is  inherent  in  its  assumption  that  one  can 


accurately  compute  the  counterparts  of  A 


q(t) 


,V 


q(t),q(t) 


and  G 


q(t) 


Unfortunately, 


this  is  not  always  the  case  in  robotics  applications.  When  A 


q(t) 


,  V 


q(t),q(t) 


and 


r 


q(t) 


,  V 


q(t),q(t; 


and  G 


q(t) 


,  the  quality  of  the  tracking 


Giq(t)  are  not  equal  to  A 
degrades  and  the  system  may  even  become  unstable.  Simulation  results  with  10%  error  in 
the  load  are  reported  in  Figures  3.8  through  3.11.  In  Figures  3.8  and  3.9,  we  can  see  that 
the  actual  trajectories  (q,  and  q9)  diverge  from  the  desired  trajectories  (q,  and  q9).  The 
position  error  is  in  the  order  of  6°  in  the  first  link  and  of  13°  in  the  second  link  (Figure 
3.10).  The  applied  torques  (Figure  3.11)  are  of  reasonable  values. 

One  may  try  to  overcome  this  limitation  by  combining  the  above  scheme  with  an  on 


line  identification  algorithm  to  compute  A 


q(t) 


,  V 


q(t),q(t) 


,  and  G 


q(t) 


71].  This, 


however,  is  computationally  demanding  since  the  computed  torque,  in  itself,  requires  a 
number  0(n4)  of  calculations,  n  being  the  number  of  links  in  the  manipulator. 
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Figure  3.2:  The  first  link  test  trajectory 
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Figure  3.3:  The  second  link  test  trajectory 
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Figure  3.4:  The  first  link  desired  (q,  (t) )  and  actual  (q(  (t) ) 
trajectories  under  the  Inverse  Dynamics  Controller 
(Perfect  Modeling) 
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Figure  3.5:  The  second  link  desired  (g~-(t)  )  and  actual  (q^(t)) 
trajectories  under  the  Inverse  Dynamics  Controller 
(Perfect  Modeling) 
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Figure  3.6:  The  joint  one  (e, (t) )  and  the  joint  two  (e^(t)) 
tracking  errors  under  the  Inverse  Dynamics 
Controller  (Perfect  Modeling) 
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Figure  3.7 


The  total  torques  applied  to  joint  one  (£,  (t) )  and 
to  joint  two  CEj(t))  under  the  Inverse  Dynamics 
Controller  (Perfect  Modeling) 
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C3 


Figure  3.8:  The  first  link  desired  (q, (t) )  and  actual  (q,(t)) 
trajectories  under  the  Inverse  Dynamics  Controller 
(Approximate  Modeling) 
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C3 


Figure  3.9 


The  second  link  desired  (q^(t) )  and  actual  (q^(t) ) 
trajectories  under  the  Inverse  Dynamics  Controller 
(Approximate  Modeling) 
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Figure  3.10:  The  joint  one  (e, (t) )  and  the  joint  two  (e^(t) ) 

tracking  errors  under  the  Inverse  Dynamics 
Controller  (Approximate  Modeling) 
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Figure  3.11 


The  total  torques  applied  to  joint  one  C&,  (t))  and 
to  joint  two  CS^(t) )  under  the  Inverse  Dynamics 
Controller  (Approximate  Modeling) 
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2.  Variable  Structure  System 

A  different  approach  which  yields  a  simple  and  robust  control  can  be  obtained  by 
using  a  variable  structure  strategy.  The  theory  of  variable  structure  control  has  mostly 
been  developed  in  the  Soviet  Union  over  the  last  25  years  and  has  found  applications  in 
many  industrial  processes  [72].  The  fundamental  idea  behind  the  theory  of  variable 
structure  is  to  allow  the  controller  to  switch  between  different  strategies,  according  to 
appropriate  functions  of  the  trajectory  error. 

A  variable  structure  control  is  of  the  form: 


u    <X  (t),t)  = 
pzv    pv  ;'  ' 


r  S/V'M  W  >  ° 


(3.24) 


for     i  =  1,  2,...,  n,     where    u    •    is  the    i       component  of  the  input  vector  U    and, 

pi  p 

S-(e-)  =  ce-  +  e-,  c-  >  0,  is  the  i  component  of  the  switching  hyper  surfaces.  The  design 
problem  consists  of  choosing  the  functions  u* .,  u "  •,  and  the  switching  hyperplane  matrix 
C  =  diag(c)  such  that  the  sliding  mode  occurs  on  the  switching  hyperplanes,  the  tracking 
error  has  an  acceptable  transient  response  and  it  goes  to  zero  asymptotically  as  t  ->  oo.  This 
methodology  is  simulated  on  the  two  link  arm  model.  The  desired  trajectories  are  the  same 
as  before.  The  switching  planes  are  chosen  as: 

S  j  =  0.5e.  +  e< 

S^=  0Ae2+  e2 
In  addition,  to  ensure  the  existence  of  the  sliding  modes,  the  control  law  is  chosen  as: 

V(Xp(t)'t)  =  _[°S|eil+,''l^l+a»|e2l+0'l^l+a'|qil+^lsSn(Si) 

In  the  absence  of  a  procedural  method  to  selecting  the  parameters  ak  a  possible  choice 

which  will  facilitate  the  calculations  is: 

ai  =  0  ,  a2  =  0  ,  a3  =  0  ,  a4  =  0  ,  a5  =  0  and  a  =10 
11111  i 

fti  =  0  ,  a2  =  0  ,  a3  -  o  ,  £>4  -  o  ,  a5  =  q  and  a   =  20 

2  2  2  2  2  2 
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The  results  of  this  computer  simulation  are  reported  in  Figures  3.12  through  3.15.  In 

Figure  3.12,  the  first  link  actual  trajectory  (q,)  tracks  the  desired  trajectory  (q, )  with 

approximately  7°  error  because  of  poor  choice  of  the  parameters  ai.  The  actual  trajectory  of 

the  second  link,  however,  shows  better  tracking  as  seen  in  Figure  3.13.  Figure  3.14  shows 

the  time  evolution  of  the 'errors  e,  and  e2  in  both  joints.  As  expected,  Figure  3.15  shows 

considerable  chattering  in  the  input  signals.  These  simulation  results  highlight  the  fact  that 

chattering  in  the  input  signals,  absence  of  a  procedural  method  to  choosing  the  control 

parameters  oi,  and  the  difficulty  of  guaranteeing  the  existence  of  the  sliding  modes  are  the 

main  reasons  that  limit  the  applicability  of  this  scheme  to  multivariate  control  systems. 

3.    Adaptive  Linear  Model  Following  Control 

This  scheme  is  depicted  in  Figure  3.1C.  The  reference  model  is  chosen  to  be  a  stable, 

linear,  time  invariant  and  decoupled  system  as: 

X    ft)  =  A    X    (t)  +  B    U    (t)  (3.25) 

nr  '         m   mv  ;         m   nr  ;  v        ' 

where  the  torques  U    (t)  are  selected  so  that  the  output  X    (t)  of  the  model  follows 


nr 


nr 


precisely  the  desired  trajectories,  described  by  the  user.  A     and  B     are  of  the  form: 


A     = 
m 


0 


In 


B     = 
m 


diag(am0l.):-diag(am;i)J 
0 

In 


(3.26) 


(3.27) 


with 


a    o-  >  0  ,  a    *  ■  >  0 
mOi         '    mh 


For  the  purpose  of  simulation,    a    ~.  =  1.5    and    a    -.  =  2.5,    i  =  1,  2.  The  manipulator 


input  U    is  chosen  as: 

U  (v.X  ,t)  =  $(v.X  ,t)X„  -  K  X    +  *(v,X  .t)U     +  K  U 
pv       p'  ;         v       p'  ;    p        p   p         v  '    p '  '    m         u    m 


(3.28) 
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Figure  3.12:  The  first  link  desired  (q, (t))  and  actual  (q,(t)) 

trajectories  under  the  Variable  Structure 
Controller  (Perfect  Modeling) 
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Figure  3.13:  The  second  link  desired  (q^(t) )  and  actual  (q^(t)) 

trajectories  under  the  Variable  Structure 
Controller  (Perfect  Modeling) 
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Figure  3.14:  The  joint  one  (e,(t))  and  the  joint  two  (e^(t)) 

tracking  errors  under  the  Variable  Structure 
Controller  (Perfect  Modeling) 
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Figure    3.15 


The  total  torques  applied  to  joint  one  (^ (t))  and 
to  joint  two  (^(t))  under  the  Variable  Structure 
Controller  (Perfect  Modeling) 
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Figure  3. 1 6:   A  Linear  Adaptive  Model  Following  Control 

for  mechanical  manipulators 
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where  K    and  K    are  feedback  constant  gain  matrices  designed  for  specific  nominal  values 

of  the  plant  to  satisfy  the  perfect  model  following  conditions  given  by: 

(3.29) 
(3.30) 

with  A+(q(t))  being  the  pseudoinverse  of  A(q(t)). 

The  quantities  $  and  ^  are  generated  by  the  adaptation  mechanism  to  guarantee  the 

stability  of  the  overall  system.  Possible  choices  are: 


Kp  =  -A*(q(t))(Am-Ap) 
Ku  -  A*(q(t))  Bm 


*=<^-(sgn(Xp))T 

II   v   II  v 

*=^-^-(sgn(Um))T 
v 


(3.31) 
(3.32) 


with 


c> 


a 


Amax(RR^)_ 
Ami  n(A"i  (q(t))) 

[Amax(SST)]" 
Ami  n(A-i(q(t))) 


where 


R  =  A-i(q(t))A+(q(t))(Am  -  Ap)  +  A-i(q(t))Kp 
S=  A-i(q(t))A+(q(t))Bm-A-i(q(t))Ku 


(3.33) 

(3.34) 

(3.35) 
(3.36) 


Simulation  results  of  this  technique  with  K    and  K    obtained  from  equations  (3.29)  and 
(3.30)  at  t  =  0  as: 


Kp  =  K  (0)  = 


-.354  30.4  6.77  1.72 

30.4  4.91  1.72  .833 
'2.71  .687" 


Ku  =  Ku(0) 

687  .333 
are  reported  in  Figures  3.17  through  3.20.  Since  the  matching  matrices  K    and  K    are  not 

adjusted  in  time,  we  can  see  that  the  actual  trajectories  (q,  and  q9)  follow  the  desired 
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Figure  3.17:  The  first  link  desired  (q,(t))  and  actual  (q,(t)) 
trajectories  under  the  Adaptive  Model  Following 
Controller  (Matching  Matrices  not  adjusted) 
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Figure  3.18 


The  second  link  desired  (q^(t))  and  actual  (q^(t) ) 
trajectories  under  the  Adaptive  Model  Following 
Controller  (Matching  Matrices  not  adjusted) 


71 


•3 


5   0.05  L 


S  -0.05 


-0.1  - 


-0.15 


-0.2 


Figure  3.19:   The  joint  one  (e, (t) )  and  the  joint  two  (e^(t) ) 

tracking  errors  under  the  Adaptive  Model  Following 
Controller  (Matching  Matrices  not  adjusted) 
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Figure  3.20:  The  total  torques  applied  to  joint  one  ('Sj(t))  and 

to  joint  two  (^*a,(t))  under  the  Adaptive  Model 
Following  Controller  (Matching  Marices  not  adjusted) 
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trajectories  (q,  and  q«)  with  an  error  of  4°  in  the  first  link  (Figure  3.17)  and  of  7°  in  the 
second  link  (Figure  3. IS).  The  joints  errors  (e,  and  e«)  are  shown  in  Figure  3.19.  The 
control  signals  (Figure  3.20)  are  chattering  due  to  the  high  frequency  component. 

Using  this  type  of  adaptation,  on  line  numerical  integration  of  the  dynamics 
equations  of  motion  is  avoided.  However,  the  signals  that  the  actuators  are  required  to 
generate  (Figure  3.20)  are  about  10  times  larger  than  in  the  computed  torque  (Figure  3.11). 
This  is  a  serious  threat  to  the  plant  hardware  since  the  forcing  signals  are  discontinuous. 

To  be  able  to  reduce  the  parameters  (  and  f,  and  hence,  the  actuation  signals,  one 
should  calculate  K  and  K  that  will  satisfy  the  perfect  model  following  conditions  of 
equations  (3.29)  and  (3.30)  at  each  instant  of  time.  Simulation  results  obtained  using  this 
fact  are  given  in  Figures  3.21  through  3.24.  In  this  case,  the  trajectory  of  the  first  link 
(Figure  3.21)  as  well  as  the  trajectory  of  the  second  link  (Figure  3.22)  show  very  close 
tracking,  the  position  errors  in  both  the  first  and  the  second  links  are  reduced  to  zero 
(Figure  3.23).  The  actuation  signals  (Figure  3.24)  are  still  large.  The  main  disadvantage  of 
this  choice  is,  however,  the  added  computational  complexity. 
4.   Adaptive  Perturbation  Control 

A  block  diagram  of  this  scheme  is  shown  in  Figure  3.25.  This  methodology  uses  an 
available  nominal  model  of  the  system  and  the  recursive  Newton— Euler  equations  of 
motion  to  compute  nominal  control  inputs  for  a  given  trajectory.  These  nominal  torques 
compensate  for  all  the  interaction  forces  among  various  joints  along  the  nominal  trajectory. 

To  compensate  for  small  deviations  from  the  nominal  trajectory,  a  feedback  adaptive 
component  is  introduced.  This  adaptive  control  is  based  on  linearizing  the  manipulator 
dynamics  equations  in  the  vicinity  of  known  nominal  trajectory  set  points  to  obtain  the 
associated  perturbed  state  equation: 

e  =  Ae  +  Bdr  (3.37) 
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Figure  3.21:  The  first  link  desired  (qf(t) )  and  actual  (q,(t)) 
trajectories  under  the  Adaptive  Model  Following 
Controller  (Matching  Matrices  adjusted) 
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Figure  3.22:  The  second  link  desired  (q2(t))  and  actual  (q^(t) ) 
trajectories  under  the  Adaptive  Model  Following 
Controller  (Matching  Matrices  adjusted) 
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Figure  3.23:   The  joint  one  (e,(t))  and  the  joint  two  (e^(t) ) 

tracking  errors  under  the  Adaptive  Model  Following 
Controller  (Matching  Matrices  adjusted) 
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Figure  3.24:  The  total  torques  applied  to  joint  one  (  ^"(t) )  and 

to  joint  two  (Vz(t))    under  the  Adaptive  Model 
Following  Controller  (Matching  Marices  adjusted) 
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Figure  3.25:   Adaptive  Perturbation  Control 
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where  e  and  e  are  as  defined  earlier  and  dr  =  U  —  U  ,  U  being  the  nominal  torque  inputs 
as  obtained  from  certain  available  nominal  model  of  the  manipulator.  The  system 
parameters  A  and  B  depend  on  the  instantaneous  manipulator  position  and  velocity  along 
the  nominal  trajectory.  A  recursive  least  squares  parameters  identification  technique  is 
used  to  estimate  the  unknown  elements  in  A  and  B.  The  obtained  parameters  are  then  used 
to  formulate  a  one  step  optimal  controller  that  will  generate  the  torques  dr  to  compensate 
for  the  perturbations.  When  only  the  feedforward  torques  are  implemented,  simulation 
results  show  that  10%  error  in  the  load  produces  tracking  errors  in  both  the  first  (Figure 
3.26)  and  the  second  (Figure  3.27)  links.  As  seen  in  Figure  3.28,  these  tracking  errors  are  in 
the  order  of  6°  and  of  9°,  respectively.  The  input  torques  (Figure  3.29)  stay  within 
reasonable  limits.  Figures  3.30  through  3.33  give  the  results  of  the  same  simulations  as 
above  when  both  the  feedforward  and  the  correcting  torques  are  used.  While  an  improved 
tracking  is  experienced  in  both  the  first  (Figure  3.30)  and  the  second  (Figure  3.31)  links, 
the  joint  errors  (Figure  3.32)  are  still  of  the  order  of  5°  and  3°,  respectively.  The  input 
control  signals  (  shown  in  Figure  3.33)  stay  within  the  same  range  of  values  as  before. 
These  results  are,  however,  expected  since  this  strategy  assumes  slow  variations  and  small 
deviations  about  the  desired  trajectory. 

It  is  evident  from  the  above  discussion  that  in  order  to  extend  the  capabilities  of 
manipulators  and  improve  their  overall  dynamic  performances,  there  is  a  need  to 
investigate  and  develop  better  adaptive  control  solutions  to  current  control  problems. 

The  aim  of  the  next  section  is  to  present  a  novel  adaptive  control  law  for  mechanical 
manipulators  that  enjoys  global  stability  and  overcomes  some  of  the  limitations  of  the 
previously  studied  methodologies.  This  strategy  combines  properties  from  both  the  the  Self 
Tuning  Regulator  in  [51]  and  the  Model  Reference  Adaptive  Control  in  [63]  and  offers  itself 
to  microcomputer  implementation.  This  technique  serves  also  to  extend  the  Model 
Reference  Adaptive  Control  method  into  using  a  nonlinear  reference  model. 
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Figure  3.26:  The  first  link  desired 


[q^(t 


and  actual 


(q,(t)) 

trajectories  under  the  Adaptive  Perturbation 
Controller  (No  Adaptation) 
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Figure  3.27:  The  second  link  desired  (q^(t) )  and  actual  (q^(t)) 

trajectories  under  the  Adaptive  Perturbation 
Controller  (No  Adaptation) 
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Figure   3.28 


The  joint  one  (e,(t))  and  the  joint  two  (e^(t)) 
tracking  errors  under  the  Adaptive  Pertubation 
Controller  (No  Adaptation) 
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Figure  3.29 


The  total  torques  applied  to  joint  one  (€Tf(t)) 
and  to  joint  two  (^(t))  under  the  Adaptive 
Perturbation  Controller  (No  Adaptation) 
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Figure  3.30:  The  first  link  desired 
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and  actual 
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trajectories  under  the  Adaptive  Perturbation 
Controller  (With  Adaptation) 
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Figure  3.31:  The  second  link  desired  (q^(t) )  and  actual  (q^(t) ) 

trajectories  under  the  Adaptive  Perturbation 
Controller  (With  Adaptation) 
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Figure    3.32: 


The  joint  one  (e,(t))  and  the  joint  two  (e^(t)) 
tracking  errors  under  the  Adaptive  Pertubation 
Controller  (With  Adaptation) 
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Figure    3.33 


The  total  torques  applied  to  joint  one  ( "5)  (t) ) 
and  to  joint  two  (  'tv(t))  under  the  Adaptive 
Perturbation  Controller  (With  Adaptation) 
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D.   ADAPTIVE  NONLINEAR  MODEL  FOLLOWING  CONTROL 

Figure  3.34  illustrates  the  structure  of  the  proposed  adaptive  control  system.  The  task  of 
the  controller  is  to  generate  the  control  signals  in  order  to  follow  a  desired  trajectory 
despite  the  changes  in  the  manipulator's  parameters  and  the  errors  in  the  dynamic  model. 
The  desired  trajectory  is  specified  in  terms  of  joint  angles  qd(t)  and  their  derivatives  qd(t) 
and  qd(t).  The  total  torques  r  are  obtained  through  a  nominal  and  a  correction  loops. 

The  nominal  loop  is  justified  by  the  fact  that,  in  practice,  a  nominal  model  of  the 
manipulator  is  always  available  to  the  designer.  The  nominal  parameters  are  used  to 
construct  a  recursive  inverse  dynamics  that  generates  nominal  torques  r  .  The  inputs  q  , 
q  ,  and  q  to  the  recursion  are  obtained  by  adding  filtered  error  signals  z(t),  z(t),  and  z(t) 
to  the  desired  signals  qd,  qd,  and  qd.  The  signals  z(t)  are  chosen  such  that: 

Z(s)  =  F[s)E[s)  (3.38) 

where  F[s)  is  the  transfer  function  of  a  linear  filter  to  be  determined  and  Z(s)  and  E(s)  are 
Laplace  transform  of  z(t)  and  e(t)  respectively.  The  recursive  form  is  chosen  to  ease  the 
computation.  The  inverse  dynamics  form  is  motivated  by  the  fact  that,  in  the  case  where 
the  mechanical  manipulator  model  is  known  precisely,  an  exact  trajectory  following  is 
obtained.  The  adjusting  signals  z(t)  are  selected  to  reach  the  ideal  closed  loop  dynamics 
given  by  the  error  equation: 

e(t)  +  Kye(t)  +  K  e(t)  =  0  (3.39) 

Since  some  manipulator  parameters  such  as  load  and  inertia  vary  in  time  and  some 
others  such  as  friction  in  the  gears  and  motors  backlash  are  very  difficult  to  determine, 
additional  correction  feedback  torques  dr  are  necessary  to  account  for  any  deviations  from 
the  desired  trajectory  due  to  these  effects.  These  correcting  torques  are  generated  to 
guarantee  global  stability: 

hme(t)  =  0  (3.40) 
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Figure  3.34:  Adaptive  Nonlinear  Model  Following  Control 

(  Series  Configuration  ) 
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In  total,  the  input  torques  r  are  the  sum  of  r    and  dr. 

r  =  r    +  dr 
where  r    are  the  outputs  of  the  recursive  algorithm  given  by: 


rn(t)  =  A 


%(') 


qn(t)  +  v 


qn(t),qn(t) 


+  G 


%w 


(3.41) 


(3.42) 


and  dr  are  to  be  determined.  From  the  equations  of  motion  of  the  manipulator,  the  total 
torques  r  can  also  be  expressed  in  terms  of  the  joint  angles  q(t)  as: 


r(t)  =  A 


q(t) 


q(t)  +  V 


q(t),q(t) 


+  G 


q(t) 


(3.43) 


Subtracting  equations  (3.43)  from  (3.42)  and  substituting  dr  by  its  expression  in  equation 
(3.41)  yields: 


q(t) 


or,  since  A 


qn(t)-q(t) 


w 


q(t),qn(t),q(t),qn(t) 


+  dr 


q(t) 


is  nonsingular, 


q„  -  q  =  -  A-1 


W  +  dr 


where  the  arguments  have  been  omitted  for  convenience  and  where, 


W=AV 


with 


q(t),qn(t),q(t).qn(t) 

+AG 

:[q(t) 

qn(t) 

+AA 

q(t),q, 

(t) 

AV  =  V 

qn(t),qn(t) 

-V 

q(t),q(t) 

AG  =  G 

qn(t)" 

-G 

q(t) 

AA  =  A 

%^\ 

-A 

q(t) 

Urn 

W 

q( 

t),qn( 

t),q(t 

),qn( 

t) 

=  0 

Jn 


a^  q(t)  -  qn(t)  and  q(t)  -  qn(t). 


On  the  other  hand, 


qn-q  =  qd  +  ^-,(s2^s)fi(s))-q 


(3.44) 


(3.45) 


(3.46) 

(3.47) 
(3.48) 
(3.49) 
(3.50) 


(3.51) 
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That  is, 

qn-q=e+  1-1(88^8)^8))  (3.52) 

where  L'l(.)  is  the  inverse  Laplace  transform  of  the  given  function.  Substituting  the 


expression  of  (q    —  q)  from  equation  (3.52)  into  equation  (3.45)  we  obtain: 

'w  +  dr 


(3.53) 


e  +  L-i{s*F{s)E(s))  =  -  A"« 

Equation  (3.53)  shows  that  the  adjusting  forward  signals  are  crucial  to  the  stability  of  the 

system.  When  these  signals  are  not  used,  such  as  in  [51],  the  error  equation  is  unstable. 

Any  stable  filter  F(s)  of  the  form: 

an-2Sn"2    +  an-3sn"3    +  ..  .    +  a0 
F{s)  = (3.54) 

bnSn  +     bn-lS0'1  +      .  ..  +     b0 

will  yield  the  desired  error  equation  in  (3.39).  A  more  interesting  choice,  however,  is: 

F[s)  =  -1-  (K  s  +  K  )  (3.55) 

S2         v  P 

where  K  and  K  are  velocity  and  position  feedback  matrices,  respectively.  The  motive 
behind  choosing  F[s)  as  in  equation  (3.55)  lies  in  the  fact  that  it  relaxes  the  computation 
considerably.  This  can  be  seen  by  evaluating  z(t),  z(t),  and  z(t)  corresponding  to  this 
choice: 

z(t)  =  L-i{s*F(s)E{s)) 

z(t)  =  Kye(t)  +  Kpe(t)  (3.56) 

which  is  actually  no  more  than  velocity  and  position  measurements  feedback.  The 
quantities  z(t)  and  z(t)  can  then  be  obtained  from  the  above  expression  of  z(t)  by  a  simple 
and  a  double  integration,  respectively.  With  F[s)  selected  as  in  equation  (3.55),  the  error 
equation  in  (3.53)  becomes: 


e  +  K  e+K  e=-A"i 
v  p 


W  +  dr 


(3.57a) 


Equatioi.  (3.57a)  is  an  equivalent  error  model  representation  of  the  proposed  adaptive 
control  law.  It  can  be  partitioned  into  a  linear  time  invariant  system  connected  with  a 
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nonlinear  time  varying  block  in  the  feedback  as  shown  in  Figure  3.35.  It  should  be  clear 


that  K    and  K    are  chosen  such  that  the  forward  transmission  function  is  stable. 

Notice  that,  if  a  filter  of  the  type  given  in  equation  (3.54)  is  used  instead,  the  term   is 
decomposed  as: 

F[s)  =  l-F{s) 
Hence,  equation  (3.53)  becomes: 


e  +  K  e  +  K  e  =  -  A'1 
v  p 


Wi  +  dr 


(3.57b) 


with 


Wi  -  W  +  Z,-i(F(s)£(s)) 
which  is  a  more  general  form  of  equation  (3.57a). 

It  remains  now  to  determine  the  control  inputs  dr  based  on  the  knowledge  of  some 
upper  bounds  of: 

|  W[q(t),qn(t),q(t),qn(t)j   | 
such  that  ||  e(t)  ||  <  e,  for  t  -»  oo  and  for  any  initial  conditions.  Here  t  is  a  small  number. 
Let 

jtft)  =  z(t)  =  L-^F{s)E{s)) 


rii)  =  Kye(t)  +  Kpe(t) 


The  quantity  rj(l)  is  given  by: 


rKt)  =  -Kv  QTf+  A-i 


W  +  dr 


(3.58) 


(3.59) 


with     q=K1K    =diag(a),   a->0    for   i=l,...,n,    since 
v     p  ov   v      i  '       ' 

K    =  diag(k    .).  k    .  >  0  and  K    =  diag(k   .),  k   •  >  0. 
v  ov  vi'     vi  p  &v  pz7'    pi 

Define  dr  as: 


dr(t)  =  ^(t)- 


iKt) 


with 


won 

i(t)  >  Amax(A)||  WTA"i| 


(3.60) 


(3.61) 
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Figure  3.35:   Error  model  representation  of  the  proposed 

adaptive  control  law 
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FACT: 

Equations  (3.60) 

and 

(3.61)  imply: 

lim  Tj(t)  =  0 

face 

Consequently, 

lime(t)  =  0 

t-+oo 

lim  e(t)  =  0 

/*m(qn-qd)  = 

0 

PROOF: 

The  above  claim  can  be  proven  by  choosing  a  Lyapunov  function  V(t/)  as  follows: 

v(i?) = 4-  *tm*o 

Then 

Vfa)  =  ^(t)TT(t) 
V(i?)  =  -  (VftK^  +  WTA-iKyr/  +  drTA-iKvr/ 
Notice  that  since  ft  =  diag(a  •),  a-  >  0  and  K    =  diag(k   .),  k   .  >  0,  then 

CI  V  V  C  V  c 

ftKv  =  /?=diag(3.),/??>0. 

Now  replace  dr(t)  by  their  expressions  in  (3.60)  to  obtain: 


V(t/)  -     -  rftfir)  -    W^A-iKvt;  +  Irp A^Ky 


If  we  select  f(t)  so  that: 


then 


That  is. 


with 


Amin(A-i)^>  ||  W^A^I 


V{ri)i-ri<fa<-(}min?{tnt) 


VMS-W^vfo) 


(3.62) 

(3.63) 

(3.64) 
(3.65) 


(3.66) 

(3.67) 
(3.68) 


(3.69) 


(3.70) 


(3.71) 


(3.72) 
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^mj7l  =  min(/?i),fori=i,...,n. 

by  which  (3.62),  (3.63),  (3.64)  and  (3.65)  are  satisfied. 

The  proof  for  the  case  where  the  filter  in  (3.54)  is  used,  follows  along  the  same  lines. 


QED 


The  above  control  law  is  simulated  on  the  two  link  arm  model.  The  following  values  of  I, 

K  ,  and  K    are  used: 
p'  v 


16 

0  " 

1  = 

0 

10 

"4 

0" 

K    - 

P 

0 

4_ 

"4 

0" 

K    = 

V 

0 

4 

When  10%  error  in  the  load  is  assumed,  the  tracking  quality,  when  no  feedback  corrections 
are  applied,  is  poor  in  both  the  first  (Figure  3.36)  and  the  second  (Figure  3.37)  links.  The 
joint  errors  are  of  the  order  of  6°  and  17°,  respectively  as  shown  in  Figure  3.38.  The  toque 
signals  (Figure  3.39)  are  similar  to  the  ones  obtained  from  the  inverse  dynamics  law.  There 
is  no  noticeable  improvement  (or  little)  in  the  tracking  quality  of  both  the  first  (Figure 
3.40)  and  the  second  (Figure  3.41)  links,  when  the  adjusting  signals  z(t),  z(t),  and  z(t) 
alone  are  used.  This  can  be  seen  from  the  plots  of  the  time  evolution  of  the  tracking  errors 
in  Figure  3.42,  and  of  the  input  torques  in  Figure  3.43.  However,  the  quality  of  the  tracking 
is  improved  drastically  in  both  the  first  (Figure  3.44)  and  the  second  (Figure  3.45)  links, 
when  both  the  adjusting  signals  and  the  correction  torques  are  implemented.  Figure  3.46 
shows  that  the  tracking  errors  in  both  links  are  practically  reduced  to  zero.  This  is  about  8° 
better  than  [51]  and  10°  better  than  [63].  As  expected,  figure  3.47  shows  a  moderate 
chattering,  within  a  very  acceptable  range  of  values,  in  the  control  signals.  Because 
integrators  are  used  to  generate  z(t)  and  z(t),  it  is  of  interest  to  check  that  the  presence  of 
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Figure  3.36 


The  first  link  desired  (qf(t) )  and  actual  (q  (t)  ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (No  Feedback) 
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Figure  3.37: 


The  second  link  desired  (q*(t))  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (No  Feedback) 
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Figure  3.38: 


The  joint  one  (e,(t))  and  the  joint  two  (e^(t)) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (No  Feedback) 
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Figure  3.39:  The  total  torques  applied  to  joint  one  (  &(  (t) )  and 

to  joint  two  (^(t))  under  the  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (No  Feedback) 
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Figure  3.40: 


The  first  link  desired  (q,(t))  and  actual  (q(  (t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (Using  Adjusting  Signals  alone) 
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Figure  3.41 


The  second  link  desired  (q*(t) )  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (Using  Adjusting  Signals  alone) 


102 


Figure  3.42: 


The  joint  one  (e, (t) )  and  the  joint  two  (e^(t) ) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 

Following  Controller  assuming  Parametric 
Uncertainties  only  (Using  Adjusting  Signals  alone) 
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Figure  3.43:  The  total  torques  applied  to  joint  one  (Z,  (t) )  and 

to  joint  two  (^(t))  under  the  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (Using  Adjusting  Signals  alone) 
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Figure  3.44:   The  first  link  desired  (g~(t) )  and  actual  (q,  (t) ) 

trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  Uncertainties 
only  (With  Adjusting  Signals  and  Correcting  Torques) 
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Figure  3.45:   The  second  link  desired  (q*(t) )  and  actual  (q^(t) ) 

trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  Uncertainties 
only  (With  Adjusting  Signals  and  Correcting  Torques) 
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Figure  3.4  6 


:    The  joint  one  (e,(t))  and  the  joint  two  (e^(t) ) 

tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  Uncertainties 
only  (With  Adjusting  Signals  and  Correcting  Torques) 
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Figure  3.47:  The  total  torques  applied  to  joint  one  ( £f  (t) )  and 

to  joint  two  (?i.(t))  under  the  Adaptive  Model 
Following  Controller  assuming  Parametric  Uncertainties 
only  (With  Adjusting  Signals  and  Correcting  Torques) 
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offset  measurements  in  such  signals  does  not  affect  the  tracking  quality  of  the  overall 
system.  Simulations  results  with  initial  conditions  of  e,  =  e^  =  115°  are  given  in  Figures 
3.48  through  3.51.  There  is  practically  no  degradation  in  the  tracking  quality  of  either  the 
first  (Figure  3.48)  or  the  second  link  (Figure  3.49).  The  tracking  errors  (Figure  3.50)  and 
the  input  torques  (Figure  3.51)  are  as  before.  To  show  the  robustness  of  this  methodology 
to  parameter  disturbances,  50%  error  in  the  load  is  assumed  and  a  term  of  the  form  F  = 
Csgn(q  •)  +  Vq .  is  added  to  the  plant  as  unmodelled  friction,  where  C  and  V  are  Coulomb 
friction  and  viscous  friction  constants,  respectively.  The  simulation  results  from  this  case 
with  C  =  V  =  4  are  reported  in  Figures  3.52  through  3.G3.  The  actual  trajectories  (q,  and 
q9)  diverge  considerably  from  the  desired  trajectories  (q,  and  q.-,)  when  no  feedback  is  used 
as  seen  in  Figures  3.52  and  3.53,  respectively.  The  tracking  errors  are  in  the  order  of  32°  in 
the  first  link  and  of  114°  in  the  second  link  as  shown  in  Figure  3.54.  The  required  input 
torques  are  reported  in  Figure  3.55.  A  considerable  improvement  in  the  tracking  quality  of 
both  links  is  achieved  even  when  only  the  adjusting  signals  alone  are  used  as  can  be  seen  in 
Figures  3.56  and  3.57,  respectively.  However,  the  joint  errors  are  still  of  the  order  of  12°  in 
the  first  link  and  of  23°  in  the  second  link  as  seen  from  Figure  3.58.  The  control  signals  are 
reported  in  Figure  3.59.  When  both  the  adjusting  signals  and  the  feedback  correcting 
torques  are  implemented,  the  tracking  quality  is  close  to  perfect  as  can  be  seen  in  Figure 
3.60,  for  the  first  link  and  in  Figure  3.61.  for  the  second  link.  The  errors  in  both  links 
(Figure  3.62)  are  drastically  reduced  to  approximately  0.3°  and  0.1°,  respectively;  while  the 
input  torques  (Figure  3.63)  remain  at  very  acceptable  range  of  magnitudes  with  mild 
chattering.  When  these  same  conditions  are  simulated  with  the  Adaptive  Perturbation 
Control  Law  of  [51],  the  quality  of  the  tracking  is  poor  for  both  the  first  (Figure  3.64)  and 
the  second  (Figure  3.65)  links.  Figure  3.66  shows  the  time  variations  of  such  errors.  These 
errors  are  of  an  order  of  magnitude  of  15°  in  the  first  link  and  of  12°  in  the  second  link. 
Respectively,  this  is  about  50  and  120  times  less  accurate  than  the  proposed  approach  (see 
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Figure  3.48: 


The  first  link  desired  (q,(t))  and  actual  (q,(t)) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (With  115°  offset) 
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Figure  3.49: 


The  second  link  desired  (q*(t) )  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (With  115°  offset) 
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Figure  3.50: 


The  joint  one  (e,  (t) )  and  the  joint  two  (e^(t) ) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (With  115°  offset) 
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Figure  3.51 


The  total  torques  applied  to  joint  one  ( £  (t) )  and 
to  joint  two  C2^(t))  under  the  Adaptive  Model 
Following  Controller  assuming  Parametric 
Uncertainties  only  (With  115°  offset) 


113 


2.5 


CO 

u 

C 
o 


o 


0.4     0.5     0.6 
Time  (sec.) 


Figure  3.52: 


The  first  link  desired  (q;(t))  and  actual  (q,(t)) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (No  Feedback) 
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Figure  3.53: 


The  second  link  desired  (qf(t))  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (No  Feedback) 
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Figure  3.54: 


The  joint  one  (e,  (t) )  and  the  joint  two  (e.g,(t) ) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (No  Feedback) 
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Figure  3.55:  The  total  torques  applied  to  joint  one  (T,(t))  and 

to  joint  two  (^(t))  under  the  Adaptive  Model 

Following  Controller  assuming  Parametric  and 

Unstructured  Disturbances  (No  Feedback) 
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Figure  3.56: 


The  first  link  desired  (q,(t))  and  actual  (q, (t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (With  dX  =   0) 
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Figure  3.57: 


The  second  link  desired  (q^(t)  )  and  actual  (q^(t)  ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (With  d£  =  0) 
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Figure  3.58 


The  joint  one  (e, (t) )  and  the  joint  two  (ei(t)) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (With  d'S'  =  0) 
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Figure  3.59:  The  total  torques  applied  to  joint  one  ("£((t))  and 

to  joint  two  (  ^Ct(t))  under  the  Adaptive  Model 

Following  Controller  assuming  Parametric  and 

Unstructured  Disturbances  (With  d£  =  0) 
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Figure  3.60: 


The  first  link  desired  (qf(t) )  and  actual  (q,(t)) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (Complete  Scheme) 
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Figure  3.61: 


The  second  link  desired  (q^(t) )  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (Complete  Scheme) 
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Figure  3.62: 


The  joint  one  (e, (t) )  and  the  joint  two  (e^(t) ) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (Complete  Scheme) 


124 


en 

0> 

3 
cr 
u 
o 
H 


-10  - 


Figure  3.63:  The  total  torques  applied  to  joint  one  (^,(t))  and 

to  joint  two  (^(t))  under  the  Adaptive  Model 

Following  Controller  assuming  Parametric  and 

Unstructured  Disturbances  (Complete  Scheme) 
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Figure  3.64:  The  first  link  desired  (q ,  (t) )  and  actual  (q,(t)) 

trajectories  under  the  Adaptive  Perturbation 
Controller  (With  Unmodeled  Disturbances) 
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Figure  3.65:  The  second  link  desired  (q^(t) )  and  actual  (q^(t) ) 

trajectories  under  the  Adaptive  Perturbation 
Controller  (With  Unmodeled  Disturbances) 
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Figure  3.66:   The  joint  one  (e,(t))  and  the  joint  two  (e^t)  ) 

tracking  errors  under  the  Adaptive  Pertubation 
Controller  (With  Unmodeled  Disturbances) 
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Figure  3.62).  Also,  as  seen  in  Figure  3.67,  the  input  torques  are  about  10  times  larger  than 
the  input  torques  required  by  our  control  law  (see  Figure  3.63).  Similarly,  when  the  same 
conditions  as  above  are  simulated  with  the  Linear  Model  Following  Control  Law  of  [63], 
The  actual  trajectories  (q,  and  q2)  diverge  from  the  desired  trajectories  (q,  and  q2)  as 
seen  in  Figures  3.68  and  3.69.  Figure  3.70  shows  that  the  tracking  errors  reach, 
approximately,  29°  in  the  first  link  and  35°  in  the  second  link.  Here,  again,  the  superiority 
of  the  proposed  control  methodology  is  evident. 

A  deeper  insight  into  this  adaptive  control  method  may  be  gained  by  considering  its 
relation  to  the  general  structure  of  Model  Reference  Adaptive  Systems  and  to  the  Adaptive 
Model  Following  Controller  in  particular. 

Referring  to  Figure  3.34,  the  same  system  can  be  represented  in  a  slightly  different,  but 
equivalent,  arrangement  as  shown  in  Figure  3.71.  This  particular  representation  highlights 
more  clearly  the  parallel  structure  of  this  control  law. 

Now  consider  Figure  3.72  which  gives  a  block  diagram  representation  of  the  standard 
Model  Following  Control  law  [73].  A  fundamental  difference  between  Figure  3.71  and  3.72 
is  the  fact  that  the  flow  of  signals  through  the  reference  model  in  Figure  3.71  is  reversed. 
This  results  from  our  formulation  of  the  general  manipulator  control  problem  in  which  we 
assume  that  in  practice  a  desired  trajectory  is  specified  by  the  user  and  not  the  input 
torques  to  the  manipulator. 

The  reference  model  in  the  standard  Adaptive  Model  Following  Control  is  chosen  to  be 
asymptotically  stable.  That  is,  A  is  a  Hurwitz  matrix.  The  Newton— Euler  recursion  we 
are  using  is  also  a  stable  algorithm,  in  the  sense  that  for  every  desired  trajectory  point 
(qd,qd)  where  |qd  |  <  »  and  |qd|  <  oo,  it  yields  a  vector  torque  t^  where  |  r.|  <  oo. 

The  feedforward  matrix  gain  K  ,  the  plant  feedback  matrix  gain  K  ,  and  the  model 
feedback  matrix  gain  K  in  Figure  3.72  are  chosen  such  that,  for  null  initial  conditions  and 
specific  plant  parameter  values,  perfect  model  following  exists.  That  is: 

129 


Figure  3.67:  The  total  torques  applied  to  joint  one  (£((t)) 
and  to  joint  two  (  ^(t))  under  the  Adaptive 
Perturbation  Controller  (With  Unmodeled  Disturbances) 
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Figure  3.68:  The  first  link  desired 


(q,(t))  and  actual  (q,(t)) 
trajectories  under  the  Adaptive  Model  Following 
Controller  (With  Unmodeled  Disturbances) 
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Figure   3.69 


The  second  link  desired  (q^(t) )  and  actual  (q^(t) ) 
trajectories  under  the  Adaptive  Model  Following 
Controller  (With  Unmodeled  Disturbances) 
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Figure    3.70 


The  joint  one  (e, (t) )  and  the  joint  two  (e^(t) ) 
tracking  errors  under  the  Adaptive  Model  Following 
Controller  (With  Unmodeled  Disturbances) 
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Figure  3.71 :  Adaptive  Nonlinear  Model  Following  Control 

(  Parallel  Configuration  ) 
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Figure  3.72:   The  standard  Adaptive  Linear  Model  Following  Control 
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In  the  proposed  adaptive  control  methodology  of  Figure  3.71  ,  the  reference  model  is  an 
available  nominal  model  of  the  plant  itself  used  as  an  inverse  dynamics.  That  is,  in  at  least 
a  limited  range  of  applications  for  which  it  has  been  calculated,  this  model  adequately 
describes  the  plant  under  consideration.  When  this  is  the  case,  perfect  model  following  can 
be  achieved  without  the  need  for  any  adjustment,  by  choosing  K  =  0,  K  =0  and  K  = 
In.  This  particular  choice  of  K  ,  K  ,  and  K  means  that  in  the  case  where  the  values  of 
the  plant  parameters  are  precisely  known  and  do  not  vary  during  operation,  the  adaptation 
mechanism  is  not  needed  just  as  in  the  standard  Adaptive  Model  Following  Control.  In 
fact,  the  control  law  reduces  to  an  inverse  dynamics  control.  Simulation  results  of  this 
situation  are  shown  in  Figures  3.73  through  3.76.  Figures  3.73  and  3.74  show  that,  in  the 
ideal  case  where  all  the  parameters  are  known,  the  actual  trajectories  (q,  and  q«)  follow 
very  closely  the  desired  trajectories  (q,  and  q9),  with  no  need  for  adaptation.  The  time 
evolution  of  the  joint  errors  (e,  and  e2)  are  converging  to  zero  as  we  can  see  from  Figure 
3.75.  Figure  3.76  shows  that  the  corresponding  input  torques  are  within  an  acceptable 
range  of  values  and  of  reasonable  chattering. 

As  for  the  standard  Adaptive  Model  Following  Control,  when  the  perfect  model 
following  exists,  the  role  of  the  adaptation  is  to  assure  the  convergence  to  this  solution 
when  the  plant  parameters  are  uncertain  or  vary  during  operation.  This  is  shown  to  be  the 
case  in  equations  (3.64)  through  (3.70).  This  adaptation  law  can  be  classified  as  a  signal 
synthesis  adaptation  since  the  feedback  signals  z(t),  z(t)  and  z(t)  are  used  to  either  reshape 
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Figure  3.73: 


The  first  link  desired  (q,(t))  and  actual  (q((t)) 

trajectories  under  the  Nonlinear  Adaptive  Model 

Following  Controller  (Perfect  Modeling) 
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Figure  3.74: 


The  second  link  desired  (qf(t))  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  (Perfect  Modeling) 
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Figure  3.75: 


The  joint  one  (e,(t))  and  the  joint  two  (e^(t) ) 
tracking  errors  under  the  Nonlinear  Adaptive  Model 
Following  Controller  (Perfect  Modeling) 
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Figure  3.76 


The  total  torques  applied  to  joint  one  (  £",  (t)  )  and 
to  joint  two  (%.(t))  under  the  Adaptive  Model 
Following  Controller  (Perfect  Modeling) 
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the  forward  torques  r  or  to  generate  additional  torques  dr  which  are  both  acting  as  input 
signals  to  the  plant  when  the  values  of  its  parameters  differ  from  the  nominal  ones. 

The  fact  that  the  flow  of  the  signals  through  the'  reference  model  in  Figure  3.71  is 
reversed,  does  not,  theoretically,  affect  the  equations  governing  the  overall  system.  This 
can  be  seen  from  the  equivalent  error  model  representation  of  equation  (3.57)  and  Figure 
3.35  which  is  the  same  structure  as  for  the  standard  Adaptive  Model  Following  Control. 

Finally  note  that  this  method  is  very  insensitive  to  the  parameters  ^(t).  Simulation 

results  when 

T20      0 


W  = 


and  when 


t(t)  = 


0       16 


120      0 


0      US 

are  reported  in  Figures  3.77  through  3.80.  Figures  3.77  and  3.78  are  practically  the  same  as 
Figures  3.60  and  3.61  obtained  earlier  with  a  different  gain  matrix  ^(t).  The  robustness 
property  is  inherent  to  the  fact  that  the  proposed  control  law  is  a  switching  law  as  can  be 
seen  from  Equation  (3.60).  Figures  3.79  and  3.80  show  that,  when  the  gains  matrix  is 
excessively  large  (8  times  the  nominal  values),  the  quality  of  the  tracking  is  degraded. 
However,  the  joint  errors  experienced  in  this  case  may  still  be  more  tolerable  than  the  the 
joints  errors  experienced  with  the  control  law  of  [51]  or  the  control  law  of  [63]. 

It  is  also  very  important  to  point  out  that  the  proposed  adaptive  control  law  is 
numerically  more  efficient  than  [51]  since  it  does  not  explicitly  estimate  the  feedback 
model,  and  more  efficient  than  [63]  because  it  does  not  require  the  use  of  model  matching 
matrices.  This  should  be  very  attractive  feature  since  adaptive  control  techniques  suffer 
from  computational  complexity  in  general. 
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Figure  3.77:   The  first  link  desired  (q,(t))  and  actual  (q,(t)) 

trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (With  Large  Gains) 
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Figure  3.78 


The  second  link  desired  (ql(t) )  and  actual  (q^(t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (With  Large  Gains) 
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Figure  3.79: 


The  first  link  desired  (qf(t))  and  actual  (q, (t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (Very  Large  Gains) 
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Figure  3.80: 


The  second  link  desired  (q  (t) )  and  actual  (q  (t) ) 
trajectories  under  the  Nonlinear  Adaptive  Model 
Following  Controller  assuming  Parametric  and 
Unstructured  Disturbances  (Very  Large  Gains) 
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E.   CONCLUSIONS  AND  FUTURE  RESEARCH 

A  new  adaptive  control  law  for  mechanical  manipulators  that  maintains  uniformly  good 
performance  over  a  wide  range  of  motions  and  payloads  has  been  developed.  This  control 
strategy  has  been  shown  to  combine  properties  from  both  the  Model  Reference  Adaptive 
Control  and  the  Self  Tuning  Regulator  theory.  It  has  also  been  shown  that  this  method 
serves  to  extend  the  Adaptive  Model  Following  Control  Approach  into  using  a  nonlinear 
model  as  a  reference. 

The  design  procedure  is  simple  and  systematic  resulting  in  an  overall  system  which  is 
globally  stable  and  offers  itself  to  microprocessor  implementation.  We  have  also  shown  that 
this  control  law  is  robust  with  respect  to  variations  of  the  plant  parameters.  The 
effectiveness  of  the  approach  has  been  demonstrated  on  several  computer  simulations  which 
compare  its  performances  against  some  of  the  commonly  known  adaptive  control 
techniques.  In  all  cases,  the  proposed  adaptive  control  strategy  has  performed  better. 

This  adaptive  control  scheme  has  reduced  the  chattering  in  the  input  torques  to  a 
"reasonable"  value  compared  to  [59]  and  [63].  We  are  currently  investigating  ways  to 
eliminate  this  chattering  completely.  As  has  been  shown  in  the  previous  section,  the 
chattering  is  the  result  of  the  correction  torques  attempting  to  counterbalance  the  effect  of 
errors  in  the  manipulator  parameters.  If  the  manipulator  model  is  precisely  known,  the 
correction  torques  are  reduced  to  zero  and  the  controller  becomes  an  inverse  dynamics. 
This  can  be  achieved  by  off  line  identification  tests.  Also  it  has  been  shown  that  in  practice 
most  of  the  manipulator  parameters  can  be  measured  or  estimated  beforehand  and  only  the 
parameters  that  are  load  dependent  are  unknown  [74].  Using  this  fact,  simulations  with  on 
line  recursive  least  squares  estimation  of  the  load  alone  are  currently  underway. 


146 


APPENDIX 
DYNAMICS  OF  THE  TWO  LINKS  PLANAR  MECHANICAL  MANIPULATOR 

A.  INTRODUCTION 

The  two  revolute  joints  planar  mechanical  manipulator  shown  in  Figure  A.l  is  used  as 
the  basis  for  our  simulations  throughout  this  study.  In  this  Appendix,  the  dynamic 
equations  describing  the  motion  of  this  physical  system  are  derived  using  the  Lagrangian 
Euler  equations  of  Chapter  2. 

B.  NOTATION 

The  same  notation  and  conventions  as  established  in  Chapter  2  are  also  employed  here. 
In  addition,  for  i  =  1,  2.  the  following  variables  are  used  to  denote: 

0  ■  the  joint  angle,  which  also  serves  as  the  generalized  coordinate; 

m  ■  the  mass  of  link  i; 
i 

/•  the  length  of  link  i\ 

1  ■  the  distance  from  the  proximate  joint  to  the  center  of  mass  of  link  i\  and 

I  •  the  moment  of  inertia  of  link  i  about  the  axis  z  •. 
i  i 

C.  EQUATIONS  OF  MOTIONS 

Equation  (2.15)  of  Chapter  2  can  be  used  to  derive  the  kinetic  energy  K  •  of  link  i.  This 
equation  can  also  be  broken  down  into  a  translational  and  a  rotational  parts  as: 

K.=  -i-in,vI,v „.-  +  -i-w$Lw.  (A.l) 

where  v     denotes  the  linear  velocity  of  the  center  of  mass  of  link  i  and  w  •  the  angular 
velocity  of  link  i  about  z , 
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Figure  A.  1 :  A  two  link  Mechanical  Manipulator 
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The  total  kinetic  energy  K  of  the  manipulator  is  then: 

K  =  £  K  • 
i=i    i 

The  total  potential  energy  is  found  using  equation  (2.20)  of  Chapter  2  as: 


(A.2) 


P  =  -  ,E  rn  ■  g  c  • 

where  c-  is  the  position  of  the  center  of  mass  of  link  i  and  g  the  gravity  row  vector. 
From  Figure  A.l, 

~lcl\  sin(^) 
lcl-6l  cos(^) 
0 
{/.,  sin  (^)  +  /cgSin(^  +  ^2)}  6X  -  lc2s\n(0^02)  \ 
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+ 


m 


l2    tf 
2    4      v2 


I 


+  -%-  mgl2cos{0l+62)  {IjCosiO^  +  -f-  cos(^+^2)}  Qfy 
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P  =  (mi  +  2mjg)g-2— sin(^)  +  m^g  -^-  sin(^+^2)  (A. 10) 

where  /  .  and  /  «  have  been  replaced  by  —x —  and  -* — ,  respectively. 

Without  loss  in  generality,  we  assume  L  =  L  =  /,  and  perform  the  operations  in  the 
Lagrangian  equations.  After  rearranging,  we  obtain  the  following  actuators  torques: 


all    a12 
a21     a22 
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vlll   v112  v121  v122 
v211   v212v221  v222 
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(A.ll) 


(A. 12) 
(A. 13) 
(A. 14) 
(A. 15) 
(A. 16) 
(A. 17) 
(A. 18) 
(A. 19) 
(A.20) 
(A.21) 
(A.22) 
(A.23) 

(A.24) 
(A. 25) 


G1    =g/{-^cx)s(01)  +  roJg(cos(01)  + jJ — ?)} 

G2    =  -y  m^g  /cos(^  +  ^2) 

Equations  (A.ll)  through  (A. 25)  constitute  what  is  known  as  the  inverse  dynamics  form 

of  the  equations  of  motion  of  the  two  link  mechanical  manipulator  of  Figure  A.l.  These 
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equations  are  used  in  Chapter  Three  to  evaluate  the  performance  of  many  commonly 
known  adaptive  control  algorithms  as  applied  to  robotic  manipulators.  The  reason  for  this 
choice  is  that  Equations  (A.  11)  through  (A. 25)  are  relatively  simple  enough  to  keep  the 
operations  manageable,  and  yet,  representative  of  the  systems  under  study. 
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